R-977 

INERTIAL  NAVIGATION  SYSTEM  STANDARDIZED 
SOFTWARE  DEVELOPMENT 

FINAL  TECHNICAL  REPORT 

Volume  II  of  IV 

INS  SURVEY  AND  ANALYTICAL  DEVELOPMENT 
June  1976 


Reproduced  From 
Best  Available  Copy 


19980820  130 


The  Charles  Stark  Draper  Laboratory,  Inc. 

Cambridge,  Massachusetts  02139 


Approved  for  public  release;  distribution  unlimited. 


SCCURfTY  CLASSIFICATION  OF  THIS  PAGE  Dttm  Enfered) 


REPORT  DOCUMENTATION  PAGE 


t.  report  number 

R-977 


[2.  GOVT  ACCESSION  RO. 


READ  LSSTRUCTIONS 
BEFORE  COMPLETING  FORM, 


•S  CATALOG  NUMBER 


4.  title  <’»nrf5t.5Nir»; 

INERTIAL  NAVIGATION  SYSTEM  STANDARDIZED 
SOFTt^ARE  DEVELOPMENT,  FINAL  TECHNICAL  REPORT, 


5.  type  of  report  a  period  covered 

3/15/76-4/30/76 _ _ 

6.  PERFORMING  ORG.  REPORT  NUMBER 


VOLUME  II  .  INS  SURVEY  AND  ANALYTICAL  PET 

7.  AUTH0R(»> 


6.  CONTRACT  OR  GRANT  NUMSERTaJ 


J.  Sciegienny,  R.  Nurse,  J.  Wexler,  P.  Kampion  F33615-75-C-1149 


10.  PROGRAM  element.  PROJECT.  TASK 
AREA  6  WORK  UNIT  NUMBERS 


PERFORMING  organization  NAME  ANO  ADDRESS 

The  Charles  Stark  Draper  Laboratory,  Inc. 

68  Albany  Street 

Cambridge,  Massachusetts  02139 _ _ _ _ 


Task  4.2.1 


n.  CONTROLLING  OFFICE  NAME  AND  ADDRESS  q.,  , 

Air  Force  Avionics  Laboratory  _ June  1976 - - 

Wright-Patterson  Air  Force  Base 

>  Aooaessot  iron,  Con,»,Unt  O^—  '»■  SeCURITY  CLASS.  <ol  .M,  ,»pc„) 


UNCLASSIFIED 


"TSj!  OECL  ASSIFICATION/OOWNORADING 
SCHEDULE 


"is.  DISTRIBUTION  STATEMENT  (of  ihtm  Rapoft) 


Approved  for  public  release;  distribution  unlimited. 


17.  DISTRIBUTION  STATEMENT  (oi  ihm  Mbstr»ct  Black  20,  1/  dff/0r»nt  trotn  RmpoH) 


19.  KEY  WORDS  fCaoffmi#  on  rorarj*  «»c##  U  i%»cmsamty  tnd  Identity  by  b/ocfc  ntjmbw} 

Inertial  Navigation 
Computer  Algorithms 
Computation  Errors 

20.  ABSTRACT  (Continu*  on  .......  »ld9  H  nmcammatj  IdMtIiT  block  numbf) 

Section  I  of  this  volume  provides  a  summary  of  the  navigation  coii5>utations  for 
seven  aircraft  inertial  navigation  systems  (INS) :  four  of  the  INS  are  local  ve^ 
tical  systems  (north  slaved,  wander  azimuth  and  free  azimuth);  one  INS  is  space 
stable;  and  the  remaining  two  are  strapdown. 

Section  2  presents  the  detailed  navigation  and  attitude  equations,  applic^le 
to  any  of  the  aforementioned  INS,  using  both  local  vertical  wander  azimuth 
(LVWA)  and  space  stable  computational  frames.  The  LVWA  frame  is  selected  fqr_^ 

00,^5^7,  1473  eomOM  OF.  NOV  6S,S  OBSOLETE  _ TTWfT  AgSTVTKn _ _ 

SECURITY  CLASSIFICATION  OF  THIS  PAGE  (WTian  Dal* 


UNCLASSIFIED 


SECURITr  CLASSIFICATION  OF  THIS  PAGEO^han  Dmtm  Bnfrmd) 

[  '  "• . .  ;■  . -  ■  -n  -  .  ■  ---nTr-i-  1  1  .  -  - 1  .  t,  .  T  -  ,  ,  , 

20.  Abstract  (continued) 

the  development  of  "standard”  navigation  algorithms  using  a  standardized  nota¬ 
tion  and  symbology.  The  "baseline"  algorithm  is  similar  to  that  used  in  several 
existing  moderate  accuracy,  local  vertical,  aircraft  INS. 

The  "upgraded"  algorithm  contains  several  minor  modifications  to  the  "baseline" 
algorithm  which  improve  the  computational  accuracy  of  the  latter.  The  modifica¬ 
tions  are  derived  in  the  appendices.  Transformations  required  to  use  the 
"standard"  algorithms  with  space  stable  or  strapdown  systems  are  also  presented 
in  this  section. 

Section  3  summarizes  the  INS  computations  presented  in  the  previous  section. 

Section  4  provides  a  survey  of  the  use  of  INS  computations  by  other  avionics 
subsystems,  with  particular  reference  to  the  parameters,  formats,  data  rates, 
and  accuracy  requirements. 

Section  5  presents  the  tradeoffs  leading  to  the  selection  of  the  LVWA  computa¬ 
tional  frame  for  the  "standard"  algorithm. 

Section  6  (euid  Appendix  A)  present  the  standardized  symbology  and  frame  defini¬ 
tion  employed  in  the  "standard"  algorithms  and  simulator  development. 


UNC 


SECURITY  CLASSIFICATION  OF  THIS  PACEfRTlM  Df 


R-977 


INERTIAL  NAVIGATION  SYSTEM  STANDARDIZED 
SOFTWARE  DEVELOPMENT 


FINAL  TECHNICAL  REPORT 
VOLUME  II 


INS  Survey 
and 

Analytical  Development 


June  1976 


Approved : 


The  Charles  Stark  Draper  Laboratory,  Inc 
Cambridge,  Massachusetts  02139 


ACKNOWLEDGEMENT 

This  four-volume  report  was  prepared  under  USAF  Contract 
F33615-75-C-1149  by  Charles  Stark  Draper  Laboratory,  Inc., 
Cambridge,  Massachusetts,  in  accordance  with  Section  4  of  the  con¬ 
tract.  The  monitoring  Air  Force  project  engineer  is  Captain  E. 
Harrington  (RWA-2) ,  Air  Force  Avionics  Laboratory,  Dayton,  Ohio. 

The  Draper  Laboratory  Program  Manager  for  this  task  is 
Dr.  George  T..  Schmidt  and  the  Lead  Engineer  is  Arthvur  Ciccolo. 

The  coordinator  of  this  report  is  Janusz  Sciegienny  and  the  authors 
are  Janusz  Sciegienny,  Roy  Nurse,  Peter  Kampion  and  John  Wexler. 

The  authors  express  their  appreciation  to  Mr.  W.  Shephard, 

Mr.  D.  Kaiser  and  Mr.  Stan  Musick  of  the  Air  Force  Avionics  Labora¬ 
tory  for  their  assistance  during  the  course  of  this  contract. 


li 


TABLE  OF  CONTENTS 


1.0 

1.1 

1.2 

1.2.1 

1.2.2 

1.2.3 

1.2.4 
1.3 

1.3.1 

1.3.2 

1.3.3 

1.3.4 

1.4 

1.4.1 

1.4.2 

1.4.3 

1.4.4 

1.5 

1.5.1 

1.5.2 

1.5.3 

1.6 
1.6.1 
1.6.2 

1.6.3 
1.7 

1.7.1 

1.7.2 

1.7.3 

1.7.4 


VOLUME  II 


SURVEY  OF  INS  NAVIGATION  COMPUTATIONS. 


Page 


Introduction . 

Summary  and  Conclusions... . . . 

Commonalities  and  Differences  in  Navigation  Compu¬ 
tations  . 

Comparison  of  Gravity  Models . . 

Detailed  Form  of  Navigation  Equations  Mechanization.  1”6 

'  1—6 

Commonality  of  Symbology . ' 

KT-73  Inertial  Navigation  Computations . . . 1-7 

General . 


Coordinate  Frames. 


Position  and  Velocity  Computations. 1-11 

Attitude  Computations . . . 1-12 

LN-15  Inertial  Navigation  Confutations . 1-14 

_ _  ,  . 1-14 


1-12 


General, 


1-15 


Coordinate  Frames . ^ 

Position  and  Velocity  Computations.... . 1-15 

Attitude  Computations . 1-17 

H-386  Inertial  Navigation  Confutations . l"!'^ 

^  1  1-17 

Coordinate  Frames . 1-18 

Position  and  Velocity  Computations..... . 1-21 

Carousel  IV  Inertial  Navigation  Computations . 1-24 

General . 1"24 

Coordinate  Frames. . . 1-26 

Position  and  Velocity  Computations . 1-28 

SPN/GEANS  Inertial  Navigation  Computations . 1-29 

General . 1-29 

Coordinate  Frames . . . 

Position  and  Velocity  Computations.... . 1-33 


Attitude  Computations. 


Ill 


TABLE  OF  GO-NTENTS  (CONTINUED) 

VOLUME  II 

1.8  H-429  (SIGN  III)  Inertial  Navigation  Computations .  1-36 

1.8.1  General . . 

1.8.2  Coordinate  Frames . 1-37 

1.8.3  Position  and  Velocity  Computations........ . . 

li9  SIRU  Inertial  Navigation  Computations..... . 1-39 

1.9.1  General . ^ 

.  1-40 

1.9.2  Coordinate  Frames . . . .  • 

1.9.3  Position  and  Velocity  Computations..... . 1"41 

2.0  DETAILED  NAVIGATION  EQUATION  STRUCTURE . 2-1 

2.1  Introduction . ...2-1 

2.2  Navigation  and  Attitude  Computations  . . *  *  * • 

2.2.1  General . . . . . 

2.2.2  Transformation  and  AV  Accumulation..... . ...2-2 

2.2.3  Navigation . . . 

2.2.4  Attitude . . ........2-6 

2.3  Transformations  and  Incremental  Velocity  Acciamulation.  2-15 

2.3.1  Local  Vertical  Wander  Azimuth  IMU . 2-15 

2.3.2  Space  Stabilized  IMU . 2-15 

2.3.3  Strapdown  IMU... . 2-17 

2. 3. 3.1  Strapdown  Computations  with  Local  Vertical, 

Wander  Azimuth  Frame . 2-18 

2. 3.3.2  Direction  Cosine  Matrix  and  Quaternion  Algorithms ......  2-21 

2. 3. 3. 2.1  Direction  Cosine  Updating . 2-21 

2. 3. 3. 2. 2  Quaternion  Updating . 2-26 

2. 3.3. 3  AV  Transformation  for  SD  IMU . . .....2-34 

2.4  Navigation  Equations..... . ...2-35 

2.4.1  Navigation  Equations  in  Local  Vertical  Frame.. . 2-35 

2. 4. 1.1  Methods  of  Presentation . 2-37 

2. 4. 1.2  Exact  Equations . 2-39 

2.4.2  Vertical  Channel  Damping . 2-43 

2.4.3  "Baseline"  Navigation  Algorithm  (in  Difference 

Equation  Form) . 2-45 

2. 4. 3.1  Upgrading  Baseline  Navigation  Algorithm . 2-56 

2. 4. 3. 1.1  Introduction . 2-56 

2. 4. 3. 2  Approach . 2-57 

iv 


TABLE  OF  CONTENTS  (CONTINUED) 


2.4.4 

2.5 

2.5.1 

2.5.2 

2.5.3 

2.5.4 

2.5.5 
3;0 

3.1 

3.2 

3.3 

3.4 

3.5 

3.6 
4.0 

4.1 

4.2 

4.3 


4.3.1 

4.3.2 

4.3.3 

4.4 

4.5 

4.6 

4.7 
5.0 

6.0 


VOLUME  II 


Improved  Accuracy  Navigation  Algorithm .  2-58 

Attitude  Computations .  2-69 

Local  Vertical  Wander  Azimuth  IMU .  2-69 

Space  Stabilized  IMU . 2-69 

Strapdown  IMU . 2-70 

Attitude  Extraction .  2-70 

Attitude  Predictor-Filter .  2-71 

SUMMARY  OF  INS  NAVIGATION  COMPUTATIONS .  3-1 

Introduction .  3-1 

Summary  and  Conclusions .  3-1 

Frames  Definition .  3-3 

Position  and  Velocity  Computations  in  Local- 

level  Frame . .  3-3 

Position  and  Velocity  Computations  in  Space- 

stabilized  Frame.... .  3-6 

Attitude  Computations .  3-9 

SURVEY  OF  INS  NAVIGATION  COMPUTATIONS  INTER¬ 
FACES  WITH  NON-INERTIAL  COMPUTATIONS .  4-1 

Introduction . . .  4-1 

Summary  and  Conclusions .  4-1 

A-7-D  INS  Weapon  Delivery  and  Aircraft  Flight 

Control  Computations... . . .  4-5 

Attitude  Data .  4-5 

Attitude  Rate  Data .  4-8 

Linear  Acceleration  Data . .  4^8 

A-7D  Navigation  Displays  Computations .  4-10 

A-7D  Air  Data  Computations . . .  4-12 

C-5  INS  Navigation  Computations  Updating....  4-14 

SAR  Antenna  Motion  Compensation .  4-19 

SELECTION  OF  COMPUTATIONAL  FRAME  FOR  THE 

COMPUTER  ERRORS  SIMULATION  PROGRAM .  5-1 

SELECTION  OF  STANDARDIZED  FRAMES  SYMBOLOGY. .  6-1 


V 


TABLE  OF  CONTENTS  (CONTINUED) 

VOLUME  II 

6.1  Introduction . . .  6-1 

6.2  Proposed  Frames  Symbology  Standardization...  6-1 


APPENDIX 

A.  TRANSFORMATION  OF  COORDINATES.. . A-1 

A.l  Introduction . . . . . A-1 

A.  2  Single -Axis  Rotations . . . A-1 

A.  3  The  General  Rotation . . A-6 

A.  4  General  Circle  Diagram. . , .  A-10 

A.  4 . 1  Introduction . A-10 

A.  4. 2  Inertial  Refernce  Frame . A-16 

2 

A.  4. 3  The  Space  Stable  "Position"  Matrix,  Cq,  or 

Inertial  to  Local  Vertical  North 

Transformation . A-16 

2 

A. 4. 4  The  Attitude  Matrix,  Cg,  or  Body  to  Local 

Vertical  North  Transformation . A-17 


O' 

A. 4. 5  The  LVWA  "Direction  Cosine"  Matrix,  €21/  or 

LVWA  Platform  to  Earth  Fixed  Transformation.  A-19 

A. 4. 6  The  Space  Stable  Gimbal  Angle  Matrix,  or 

Body  to  Space  Stable  Platform  Transformation  A-21 

2 

A. 4. 7  The  LVWA  Gimbal  Angle  Matrix,  C^,  or  Body 


to  LVWA  Platform  Transformation . A-22 

A. 4.8  Other  Transformation . A-24 

A.  4. 9  A  Computational  Simplfication . A-24 

B.  DERIVATION  OF  FUNDAMENTAL  EQUATION 

OF  INERTIAL  NAVIGATION . .  B-1 

C.  THE  GEODETIC  ASTRONOMIC  AND  GEOCENTRIC 

LATITUDES . . .  C-1 

D.  IMPROVING  THE  ACCURACY  OF  THE  "BASELINE" 

LVWA  NAVIGATION  ALGORITHM . . D-1 

E.  APPROXIMATING  THE  MID  COMPUTATION  CYCLE 

TRANSFORMATION .  E-1 

F.  VERTICAL  DAMPING  FOR  THE  UPGRADED 

ALGORITHM . . F_1 


vi 


VOLUME  II 


list  of  figures 


Figure 

1-1 

1-2 

1-3 

1-4 

1-5 

1-6 

1-7 

1-8 

1-9 

1-10 

1-11 

1-12 

1- 13 

2- 1 
2-2 
2-3a 
2-3b 


2-4 

2-5 

2-6 

2-7 

2-7a 


Page 


Definition  of  KT-73  Navigation  Axes  Frames  . 

Aircraft  and  KT-73  Gimbal  Axes  . 

KT-73  Navigation  Computations  of  Position  and 

Velocity-Functional  Flow  Diagram  . 

KT-73  Navigation  Computations  of  Attitude-Functional 

Block  Diagram . . . 

LN-12  Definition  of  Coordinate  Frames  . 

Definition  of  H-386  Navigation  Axes  Frame  . 

Relationship  Between  Geocentric  and  Geodetic 

Latitude  •  •  . . . 

Functional  Flow  Diagram  for  Free  Aximuth  Navigational 

Program  . 

Carousel  IV  Coordinate  Frames  . 

Frames  Used  in  SPN/GEANS  Computations . * 

Vehicle  Frame  Axes  Used  in  SPN/GEANS  Computations  . . . 

SPN/GEANS  Position  and  Velocity  Computations- 

Functional  Block  Diagram  . . 

SPN/GEANS  Attitude  Computations-Functional  Block 

Diagram  . 

Local  Vertical  Wander  Aximuth  INS  Computational 
Flow  Diagram  with  LVWA  Computational  Frame  . 

Space  Stable  INS  Computational  Flow  Diagram  with 

LVWA  Computational  Frame  . 

High  Speed  Computations-SD  System-LVWA  Computational 

Frame  . 

Strapdown  INS  Computational  Flow  Diagram  with  LVWA 
Computational  Frame  Navigation  and  Attitude  (Low 

Speed)  Computations  . 

Space  Stable  INS  Computational  Flow  Diagram  with 

SS  Computational  Frame  . . 

Local  Vertical  Wander  Azimuth  INS  Computational  Flow 
Diagram  with  SS  Computational  Frame  . 

Strapdown  INS  Computational  Flow  Diagram  with  SS 

Computational  Frame  . . 

Flow  Chart  for  1st,  2nd  or  3rd  Order  Direction 

Cosine  Matrix  Update  .  . 

Updating  of  Body-to-Computation  Frame  Direction 
Cosine  Matrix  . 


1-9 

1-10 

1-13 

1-14 

1-16 

1-19 

1-20 

1-25 

1-27 

1-31 

1-32 


1-34 

1-35 


2-8 


2-9 

2-lOa 


2-lOb 

2-12 

2-13 

2-14 

2-23 

2-24 


r 


vii 


Figure 

2-7b 

2-8 

2-8a 

2-8b 

2-8c 

2- 9 
2-10 
2-11 

2-12 

3- 1 
3-2 
3-3 

3-4 

3-5 

3-6 

3-7 


3-8 

3-9 

3-10 

3-11 

3-12 

3- 13 

4- 1 

6-1 

6-2 

6-3 

6-4 

6-5 

A-1 
A- 2 


LIST  OF  FIGURES  (Continued) 


Page 


Direction  Cosine  Matrix  Updating  (continued).  .  2-25 

Flow  Chart  for  1st,  2nd  and  3rd  Order  Quaternion 

Update  .  2-30 

Updating  of  Body-to-Computational  Frame  Direction 
Cosine  Matrix,  Using  Quaternion  Transformation  ....  2-31 

Computation  for  Updated  D.C.M.  (continued)  .  2-32 

Computation  for  Updated  D.C.M.  (continued)  .  2-33 

Undamped  Vertical  Channel  Block  Diagram  .  2-43 

Third  Order  Damped  Vertical  Block  Diagram  .  2-44 

Attitude  Predictor-Filter  Block  Diagram  (Single 

Axis)  . 2-71 

Attitude  Filter  Gain  Select  Logic  for  a  Single 

Axis  .  2-74 

Categorization  of  the  INS  Computations  .  3-2 

Definition  of  Axes  Frames  .  3-4 

Commonality  of  Navigation  Computations  in  a  Local 
Geodetic,  Wander  Azimuth  Frame-General  Block  Diagram  3-5 

Additional  Computations  in  the  Local  Geodetic  Frame 

Required  for  Various,  INS  Configurafions-General 

Block  Diagrams  . 3-7 

Commonality  of  Navigation  Computations  in  a  Space 
Stabilized  Frame-General  Block  Diagram .  3-8 

Additional  Computations  in  the  Space  Stabilized 

Frame  Required  for  Various  INS  Configurations- 

General  Block  Diagram .  3-10 

Attitude  Computations  -  General  Block  Diagram  . 


3-11 


C-5  Kalman  Navigation/Alignment  Mechanization- 

Function  Block  Diagram  . . . . .  4-15 

Rotation  About  X-Axis,  Vector  Representation  .  6-2 

Rotation  About  X-Axis,  Circle  Diagram  Representation  6-3 

Frames  Used  in  SPN/GEANS  Computations  .  6-3 

Vehicle  Frame  Axes  Used  in  SPN/GEANS  Computations  ...  6-4 

General  Circle  Diagram  for  SS,  SD,  LVWA  INS 
Computations  . .  g_g 

Rotation  About  X-Axis  .  ;^_3 

Rotation  About  X-Axis  Flow  Diagraun  . . .  A— 3 


viii 


LIST  OF  FIGURES  (Continued 1 


Figure  Page 

A-3  Rotation  About  Y-Axis  .  A-4 

A-4  Rotation  About  Y-Axis  Flow  Diagram  . . . . . .  A-5 

A-5  Rotation  About  Z  Axis  . A-5 

A-6  Rotation  About  Z-Axis  Flow  Diagram . A-6 

A-7  Transformations  Required  for  Local  Verical  Wander 
Azimuth  INS  Navigation  Computations  in  LVWA 
Computational  Fraime .  A-8 

A-8  Transformations  Required  for  Space  Stable  INS 

Computations  in  SS  Computational  Frame  .  A-9 

A-9  General  Circle  Diagram  for  SS,  SD,  LVWA  INS  Compu¬ 
tations  .  A- 11 

A-10  Coordinate  Frames  Used  in  SPN/GEANS  Computations  ....  A-14 

A-11  Vehicle  Frame  Axes  Used  in  SPN/GEANS  Computations  . . .  A-15 

A-12  Inertial-to-Local  Vertical  Transformation  .  A-16 

A-13  Body-to-Local  Vertical  Transformation  .  A-18 

A-14  LVWA-to-Earth-Fixed  Frame  Transformation  .  A-20 

A-15  Body- to- Space- Stable  Frame  Transformation  . . .  A-21 

A-16  Body-to-LVWA-Platform  Frame  Transformation  . . .  A-23 

C-1  Latitude  Terminology . C-3 

F-1  Damped  Vertical  Channel  Computations  For  "Updated" 

Algorithm  (at  end  of  nth  computation  cycle)  .  F-3 


ix 


VOLUME  II 


LIST  OF  TABLES 


Table 

No. 

Page 

1-1 

List  of  Surveyed  INS . 

1-1 

1-2 

Cpinmonalities  and  Differences  in  the  Navigation  - 
Computation  Format  of  the  Surveyed  INS  with  Local- 
Level  Mechanization.^. . 

1-2 

1-3 

Commonalities  and  Differences  in  the  Navigation  — 
Computation  Format  of  the  Surveyed  Strapdown  INS. 

1-3 

2-1 

Local  Vertical  Wander  Azimuth  Navigation 

Algorithm  with  Vertical  Damping . 

2-7 

(2-45) 

2-2 

Space  Stable  Navigation  Algorithm  with  Vertical 
Damping  -  Subtracting  East  Velocity  of  Earth . 

2-11 

2-3 

Routines  for  Upgraded  LVWA  Navigation  Algorithm 
with  Vertical  Damping . ,, 

2-59 

4-2 

4-1 

Survey  Summary  of  INS  Software  Interfaces  With 
Avionic  Computations . ,, 

4-2 

Avionic  Systems  Use  of  Inertially  Derived  Data _ 

4-6 

4-3 

Typical  Attitude  Data  Utilization  in  A-7D  Avionic 
Computations . 

4-7 

4-4 

Typical  Attitude  Rate  Data  Utilization  in  A-7D 
Avionic  Computations . 

4-9 

4-5 

Air  Data  Computer  Measurements . . . 

4-13 

4-6 

4-7 

Typical  Characteristics  of  Navigation  Aids 
Measurements . 

IMU  Data  Requirements  for  EAR  Antenna  Motion 
Compensation . 

4-18 

4  —  on 

5-1 

Comparison  of  Local-Level  and  Space  Stabilized 
Computational  Frames . . 

ft  — 

t;-o 

6-1 

Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA 
Systems  with  SS  or  LVWA  Navigation. . 

6-5 

6-2 

Coordinate  Frames  Appearing  in  General  Circle 
Diagram . 

^  —  7 

A-1 

Definition  of  Angles  in  General  Circle  Diagram. . . 

D—  / 

A-12 

A- 2 

Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA 
Systems  with  SS  or  LVWA  Naviqation. . . 

A-13 

VOLUME  II 


1.0  SURVEY  OF  INS  COMPUTATIONS 


1.1  Introduction 

A  survey  of  INS  navigation  confutations  was  initiated  to 
investigate  the  mechanization  equations  used  in  representative 
types  of  aircraft-INS  configurations  either  deployed  or  under 
development  at  this  time. 

The  survey  results  were  used  in  design  of  the  computer 
error  simulation  program,  described  in  Volume  III  of  this  report. 

The  survey  included  INS  with  a  local-level  stabilized  plat¬ 
form,  with  a  space-stabilized  platform,  and  with  strapdown  con¬ 
figurations.  The  surveyed  INS  used  either  the  local-level  or  the 
space-stabilized  computational  frame  during  the  INS  navigation 
computations.  Table  1-1  contains  a  list  of  the  surveyed  INS,  the 
type  of  platform  stabilization,  and  the  type  of  computational 
frame  used  during  the  navigation  computations. 


TABLE  1-1.  List  of  Surveyed  INS 


! 

TYPE  OF  PLATFORM 

i  NAVIGATION  CXDMPUTATIONAL 

;  INS 

STABILIZATION 

i  FRAME  USED 

KT-73 

Local-level  geodetic 

North-pointing  below  70°  latitude 
Wander-azimuth  above  70°  latitude 

LN-15 

Local-level  wander-azimuth 

Local-level  geodetic  wander-azimuth 

H-386 

Local-level  free-azimuth 

Local-level  free-azimuth  geocentric 

Carousel 

Local -level  free-azimuth 
rota ting-level  gyros  and 
accelerometers 

Local-level  geodetic  free-azimuth 

GEANS 

Space-stabilized 

Space- s  tabil i zed 

SIGN 

III 

Strapdown 

Local-level  geocentric 

SIRU 

Strapdown 

Local-level  geodetic 
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The  following  computational  characteristics  were 
investigated; 

a.  Commonality  in  navigation  confutations  mechanization 
among  various  INS  types. 

b.  Form  of  gravity  models  employed  in  the  navigation 
computations . 

c.  Detailed  form  of  the  navigation  equations  mechaniza¬ 
tions  . 

d.  Commonality  of  coordinate  frames  and  coordinate  trans¬ 
formations  symbology  employed  in  the  navigation 
equations. 

The  survey  results  are  presented  in  sections  1.3  to  1.8 
and  summarized  in  section  1.2.  The  survey  results  were  also 
used  to  generate  sections  2,  3,  5  and  6. 

1.2  Summary  and  Conclusions 


1*2.1  Commonalities  and  Differences  in  Navigation  Computations 

•  A  comparison  of  the  commonalities  and  differences  in  the 
navigation-computation  format  of  the  surveyed  INS  with  local- 
level  mechanization  appears  in  Table  1-2. 


TABLE  1-2.  Commonalities  and  Differences  in  the  Navigation- Confutation  Format 
of  the  Surveyed  INS  with  Local -Level  Mechanization 


COMMONALITIES 

DIFFERENCES 

•  The  navigation  computations  are  per- 

•  The  local -level  computational  frames 

formed  in  a  local -level  computational 

used  in  mechanization  of  the  INS 

frame  with  world-wide  navigation 
capabilies. 

navigation  equations  are: 

(1)  LN-15  and  KT-73  (above  70°  lati- 

•  A  first-order  direction-cosine  trans- 

tude)  INS  use  geodetic  wander-azimuth 

formation  matrix  from  the  platform 
frame  to  the  earth- fixed  frame 

computational  frame. 

is  used  in  position  computations. 

(2)  KT-73  (below  70®  latitude)  INS  uses 
geodetic  north-pointing  computational 

•  Barometric  altimeter  data  is  used  to 
bound  the  vertical -channel  computa¬ 

frame. 

tions  . 

(3)  H-386  INS  uses  the  geocentric 

free-azimuth  computational  frame. 

(4)  Carousel  INS  uses  geodetic  free- 
azimuth  coitputational  frame. 
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TABLE  1-2.  Commonalities  and  Differences  in  the  Navigation-Computation  Format 
of  the  Surveyed  INS  with  Local -Level  Mechanization  (Continued) 


DIFFERENCES 

•  The  direction-cosine  matrix,  repre¬ 
senting  the  transformation  from  the 
computational  frame  to  the  earth- 
fixed  frame,  used  in  the  KT-73,  LN-15, 
and  Carousel  INS  computations  is  up¬ 
dated  using  the  angular  velocity  of 
the  coirputational  frame  with  respect 
to  the  earth-fixed  frame.  In  the 
H-386  INS  coirputations ,  the  updated 
direction-cosine  matrix  is  from  the 
computational  frame  to  the  inertial 
frame.  This  matrix  is  updated  using 
the  level -axis  components  of  the 
angular  velocity  of  the  computational 
frame  with  respect  to  the  inertial 
frame.  The  earth's  angular  velocity 
is  then  used  to  update  the  matrix 
from  the  inertial  frame  to  the  earth- 
fixed  frame. 

•  All  nine  elements  of  the  direction- 
cosine  matrix  used  in  the  KT-73,  H-386, 
and  Carousel  INS  computations  are 
updated.  In  the  LN-15  INS  computa¬ 
tions,  only  six  direction-cosine 
matrix  elements  are  updated. 

•  Orthonormalization  of  the  direction- 
cosine  matrix  is  used  only  in  the 
H-386  INS  computations. 

•  In  the  vertical -channel  navigation 
computations,  the  barometric  altim¬ 
eter  data  is  combined  with  the  in¬ 
ertial  data  as  follows: 

(1)  KT-73  and  LN-15  INS  computations 
use  third-order  damping  loops. 

(2)  Carousel  INS  computations  use 
second -order  damping  loops. 

(3)  H-386  INS  uses  barometric  data 
directly  (no  inertial  vertical 
computations  are  mechanized) . 


•  The  surveyed  INS  with  a  space-stabilized  platform  (GEANS) , 
used  a  space-stablilized  computational  frame  in  the  mechaniza¬ 
tion  of  the  navigation  computations.  The  inertially  derived 
data  is  combined  with  the  barometric  altimeter  data  on  the  accel¬ 
eration  and  the  velocity  levels  (second-order  baro-inertial  loop 
in  the  inertial  frame) . 

•  The  commonalities  and  differences  in  the  navigation-compu¬ 
tation  format  of  the  surveyed  strapdown  INS  appear  in  Table  1-3. 


TABLE  1-3.  Commonalities  and  Differences  in  the  Navigation-Computation  Format 

of  the  Surveyed  Strapdown  INS 


COMMONALITIES 

DIFFERENCES 

•  The  navigation  computations  are  per- 

•  The  SIGN  III  INS  uses  the  geocentric 

formed  in  a  local -level  north-pointing 

computational  frame,  while  the  SIRU 

coirputational  frame.  The  INS  compu- 

INS  uses  the  geodetic  computational 

tation  mechanization  is  therefore  not 

frame . 

suitable  for  operation  near  the  earth's 

poles. 

•  The  SIGN  III  INS  uses  barometric  data 
in  the  navigation  confutations,  while 

•  A  quaternion  is  used  to  e:q)ress  the 

SIRU  INS  uses  constant  altitude  in 

coordinate  transformation  from  the 
body  frame  to  the  computational 
frame . 

•  Position  is  computed  from  the  inte¬ 
gration  of  velocity. 

the  navigation  computations. 

1.2.2  Comparison  of  Gravity  Models 

The  gravity  models  used  in  the  INS  navigation  computations 
are  based  on  the  ellipsoidal  gravity  formula The  formula 
expresses  the  average  geodetic  vertical  component  of  the  earth's 
gravity  at  sea  level  in  the  form  of  a  Chebychev  expansion  approx¬ 
imation.  The  gravity  equation  consists  of  a  constant  term  and 
terms  proportional  both  to  the  square  and  to  the  fourth  powers 
of  the  sine  of  latitude.  Above  sea  level,  the  gravity  model  con¬ 
tains  an  additional  vertical  component  proportional  to  the  alti¬ 
tude,  and  a  level  (north-south)  term  proportional  to  the  product 
of  the  altitude  and  the  sine  of  twice  the  latitude  angle.  The 
magnitude  of  each  of  these  additional  terms  is  less  than  24jig. 


i 
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The  gravity  models  used  in  the  KT-73,  LN-15,  and  Carousel 
navigation  computations  consist  of  the  geodetic  vertical  con5>o- 
nents.  The  gravity  model  contains  the  constant  term,  the  term 
proportional  to  the  sine  of  the  latitude  squared,  and  the  term 
proportional  to  the  altitude.  Omission  of  the  fourth-power  sine 
of  the  latitude  term  results  in  a  gravity  error  of  less  than 
23yg.  The  KT-73  or  LN-15  gravity  models  use  the  same  values  of 
the  model  terms.  The  Carousel  gravity  model  term  values  are 
slightly  lower  than  the  corresponding  teinxi  values  in  the  KT-73 
or  LN-15  gravity  models.  The  difference  is  due  to  a  slightly 
different  value  of  the  earth  parameters  used  in  computing  the 
model  term  values.  The  resultant  difference  between  the  gravity 
magnitude  in  the  KT-73  or  LN-15  and  the  Carousel  computations  is 
less  than  20yg. 

The  gravity  models  used  in  the  H-386  and  SIGN  III  INS 
navigation  computations  consist  of  a  geocentric-vertical  and  a 
geocentric-north  component.  The  gravity  components  are  computed 
with  an  accuracy  on  the  order  of  20)jg. 

The  gravity  model  used  in  GEANS  navigation  computations 
consists  of  gravity  terms  computed  in  inertial  rectangular  co¬ 
ordinates.  The  gravity  is  computed  with  an  accuracy  of  the 
order  of  O.lyg. 

The  magnitude  of  the  gravity  error  resulting  from  the 
gravity  model  approximations  used  in  KT-73,  LN-15,  H-386,  Carou¬ 
sel,  and  SIGN  III  INS  navigation  computations  is  comparable  with 
the  magnitudes  of  the  gravity  anomalies.  In  addition,  the  ver¬ 
tical  component  of  gravity  error  has  not  significant  effect  on 
the  navigation  errors  in  navigation  computations  supplemented  by 
the  barometric  altimeter  data.  The  horizontal  component  error 
does,  however,  introduce  navigation  errors. 
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1.2.3  Detailed  Form  of  Navigation-Equations  Mechanization 

As  part  of  the  INS  navigation-computation  survey,  a 
detailed  study  of  navigation-equations  implementation  was  inves¬ 
tigated. 

Three  types  of  INS  configurations  (local-level,  space- 
stabilized,  and  strapdown)  and  two  types  of  computational  frames 
(local-level  and  space-stabilized)  were  included  in  this  inves¬ 
tigation.  The  resultant  six  forms  of  the  navigation-computation 
mechanization  are  represented  by  detailed  flow  diagrams.  In 
addition,  specialized  aspects  of  the  con5)utations  used  in  a 
strapdown  INS  were  investigated  to  determine  the  most  efficient 
mechanization  of  the  strapdown  navigation  equations  in  a  local- 
level  computational  frame.  The  details  of  the  navigation  equa¬ 
tions  mechanization  are  presented  in  section  2  of  this  volume. 

1.2.4  Commonality  of  Symbology 

The  survey  of  the  various  INS  navigation  computations 
indicates  a  lack  of  standardization  in  symbology  of  frames  and 
transformations.  The  symbology  used  varies  not  only  among  vari¬ 
ous  INS  types,  but  it  is  also  not  always  consistent  in  the  same 
type  of  INS  computations. 

In  the  KT-73  INS  computations,  for  example,  the  local-level 
platform  and  the  computational  frame  use  different  definitions 
of  axes’  orientation.  Also,  the  LN-15  series  INS  do  not  use 
consistent  symbology  of  frame  definitions.  The  survey  results, 
presented  in  section  1,  employ  symbology  used  in  the  surveyed 
reports . 

A  proposed  standardized  notation  based  on  the  Honeywell 

(2) 

convention  used  in  SPN/GEANS  '  '  is  presented  in  section  6  and 
it  is  used  in  sections  2  and  3  of  this  volume. 
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1.3  KT-73  Inertial  Navigation  Computations 


1.3.1  General 

The  KT-73  inertial  laeasurement  unit  (IMU) ,  manufactured  by 
the  Kearfott  Division  of  Singer,  is  used  in  the  AN/ASN-90(V) 
inertial  measurement  set  (IMS) .  The  IMS  is  a  part  of  the 
inertial  navigation  system  (INS)  used  on  the  Air  Force  A-7D 
tactical  fighter  bomber,  the  Air  Force  AC— 130E  gunship  and  the 
Navy  A-7E  attack  fighter-bomber. 

The  INS  uses  the  AN/ASN-91 (V)  computer  (NWDC) ,  manufactured 
by  IBM,  to  provide  navigation  and  weapon  delivery  information  to 
other  aircraft  avionic  systems.  The  NWDC  receives  inputs  from 
many  avionic  systems  including  the  AN/APN-90 (V)  doppler  radar 
set,  manufactured  by  Kearfott,  and  the  CP-953A/AJQ  air  data  com¬ 
puter,  manufactured  by  Air  Research.  The  NWDC  is  a  16,000-word, 
16-bit,  fixed-point,  magnetic-core-memory  digital  computer. 

The  KT-73  INS  contains  a  four-gimbal  platform.  The  plat¬ 
form  employs  the  two-degree-of-freedom  gyroflex  gyros,  with  one- 
degree-of-freedom  caged.  Torque-restrained,  pendulum-type 
accelerometers  mounted  on  the  platform  are  used  to  measure  the 
specific  force.  The  horizontal  components  of  the  specific  force 
are  measured  by  a  two-axis  accelerometer  and  the  vertical  speci¬ 
fic  force  is  measured  by  a  single-axis  accelerometer. 

The  platform  stabilization  below  70°  latitude  is  local- 
level,  north-pointing  and  above  70°  latitude  the  stabilization 
becomes  local -level,  wander  azimuth.  The  vertical  channel  com¬ 
putations  are  stcibilized  by  the  barometric  altimeter  data.  The 
stabilization  mechanization  employs  a  constant-gain,  third-order 
loop.  The  doppler  radar  measured  velocity  is  used  for  damping 
of  Schuler  oscillations  in  the  inertially  derived  velocity. 

The  velocity  damping  mechanization  en^jloys  second-order  constant 
gain  loops. 
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This  section  contains  a  description  of  the  navigation  com¬ 
putations  of  the  position,  the  velocity  and  the  attitude  employed 
in  the  pure  inertial  mode  of  operation  (with  no  doppler-radar 
measurements) .  The  description  is  based  on  reports  generated  at 
the  Naval  Weapon  Center,  China  Lake,  California  .  The  Center 
is  responsible  for  the  maintenance,  validation,  and  modification 
of  the  A-7  D/E  navigational  and  the  weapons  delivery  equations. 

1.3.2  Coordinate  Frames 

This  section  contains  a  definition  of  the  frames  used  dur¬ 
ing  the  navigation  computations  of  the  position,  the  velocity  and 
the  attitude.  The  symbology  of  frames  and  transformations  used 
in  this  section  is  obtained  from  Reference  (3). 

The  frames  used  during  the  navigation  computations  of  the 

position  and  the  velocity  are  the  earth  centered  frame,  x  ,  y  , . 

o  -^o 

z^,  the  platform  reference  frame,  x^,  y^,  z^,  and  the  computa¬ 
tional  frame,  x,  y,  z,  as  shown  in  Figure  1-1.  The  computational 
frame  coincides  with  the  local  vertical  geodetic  frame  for  lati¬ 
tude  L  <  70°.  For  L  >  70°  the  computational  frame  becomes  a 
wander  azimuth  frame.  (The  wander  angle  is  equal  to  a.) 

The  platform  frame  axes  are  also  in  a  local  geodetic  frame 
north-point  for  L  <  70°  latitude,  and  wander-azimuth  for  L  >  70°. 
The  platform  axes  do  not  coincide  with  the  corresponding  axes  of 
the  computational  frames.  There  seems  to  be  no  justification  for 
choosing  a  different  definition  for  the  platform  and  the  compu¬ 
tational  axes. 

The  aircraft  body  axes,  the  gimbal  axes  and  the  definition 
of  the  attitude  angles  are  shown  in  Figure  1-2. 


GREENWICH 

MERIDIAN 


Xo'Wo  “  REFERENCE 

X  Y  Z  =  LOCAL  GEODETIC.  EAST,  NORTH,  UP 
x'p,Yp,Zp  =  PLATFORM  REFERENCE,  NORTH,  EAST,  DOWN 

Xpp  =  LATITUDE,  <l>pp  =  LONGITUDE,  a=  WANDER  ANGLE 


Figure  1-1.  Definition  of  KT-73  Navigation  Axes  Frames 


z 
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T  INNER  GIMBAL 
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Figure  1-2.  Aircraft  and  KT-73  Gimbal  Axes 
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1.3.3  Position  and  Velocity  Confutations 

•  The  KT-73  inertial  navigation  confutations  are  performed 
in  a  local-vertical,  geodetic  frame,  north-pointing  below 
70°  latitude  and  with  wander-azimuth  above  70°  latitude. 


•  The  duration  of  a  basic  iterative  cycle  is  40  milliseconds. 

•  The  navigation  computations  use  direction  cosine  matrix  C, 
in  mechanization  of  transformation  from  the  computational 
frame  to  the  earth  fixed  frame.  The  matrix  is  updated 
using  a  first-order  approximate  solution  of  the  matrix 
equation : 

C  =  C(j) 

where  ^  is  the  skew  symmetric  matrix  representing  the 
angular  velocity  of  the  computational  frame  with  respect 
to  the  earth-fixed  frame  expressed  in  the  coitf utational 
frame  coordinates.  The  approximation  is  solved  using 
double-precision  computation. 

•  The  vertical  channel  computations  employ  a  third-order 
danfing  system.  (The  difference  between  the  inertially 
derived  altitude  and  the  barometric  altitude  is  applied 
through  the  proportional  and  the  integral  channels  to  the 
inertially  sensed  acceleration.  The  altitude  difference 
is  also  applied  to  the  inertially  derived  velocity.) 

•  The  gravity  computations  employ  the  gravity  model  repre¬ 
sented  by  the  following  equation; 

g  =  32.0882  (1  +  5.29  x  10“^  sin^X _ -10“\„)  ft/sec^ 

PP  O 

where  is  the  geodetic  latitude  and  h^  is  the  barometric 
PP  o 

altitude . 
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Figure  1-3  presents  a  functional  flow  diagram  of  the  KT-73 
INS  computations  of  position  and  velocity  in  the  local  level, 
geodetic,  wander  azimuth  computational  frame.  (For  a  north¬ 
pointing  computational  frame  the  wander  angle  a  is  zero.)  The 
velocity  increments  AV  sensed  by  the  accelerometers  and  resolved 
along  the  con5)utational  frame  axes  are  combined  with  the  V/R 
terms  and  with  the  Coriolis  correction  terms.  The  computed 
horizontal  velocity  is  resolved  through  the  wander  angle  a,  into 
the  east  and  north  components.  Computation  of  the  vertical 
velocity  coiqponent,  requires  the  magnitude  of  the  local 
gravity.  In  addition,  the  barometric  altitude,  h„,  is  used  in  a 
third-order  damping  loop  to  bound  the  vertical  channel  instabil¬ 
ity.  The  coit5)uted  horizontal  velocity  is  used  in  the  computa¬ 
tion  of  the  angular  rate,  (J),  of  the  computational  frame  with 
respect  to  the  earth-fixed  frame.  The  (j)  is  used  to  update  the 
direction  cosine  matrix  transformation  between  the  computational 
frames  and  the  earth  fixed  frame.  The  updating  is  based  on  solu¬ 
tion  of  the  differential  equation  C  =  C({).  The  latitude,  Xpp» 

longitude,  <(>  _»  and  the  wander  angle,  a,  are  computed  from  the 
Jb^ 

C  matrix  terms.  The  components  of  the  angular  rate  <J)  and  the 
matrix  C  are  used  in  computation  of  the  gyro  torquing  signals 


1.3.4  Attitude  Computations 


The  aircraft  attitude  is  defined  by  the  orientation  of  the 
aircraft  body  axes  shown  in  Figure  1-2,  with  respect  to  a  local 
geodetic  axes  shown  in  Figure  1-1.  The  attitude  angles,  roll,  pitch, 
yaw,  are  defined  respectively  by  the  angles  of  rotation  about  the 
x,y,z  aircraft  axes  required  to  bring  the  aircraft  frame  axes 
to  coincide  with  the  corresponding  local  geodetic  frame  axes. 


Figure  1-4  presents  a  fiinctional  flow  diagram  of  the  KT-73 
navigation  computation  of  attitude  in  the  local-level,  geodetic, 
wander  azimuth  computational  frame.  The  aircraft  attitude  angles 
are  computed  by  solving  the  following  matrix  equation. 


Attitude  angles  matrix  =  Transformation  matrix  from  the 

aircraft  body  axes  to  the  local 
geodetic  axes 


The  transformation  matrix  from  the  ^ody  axes  to  the  geodetic 
axes  is  a  function  of  the  four  gimbal  angles  and  the  wander  angle  , 


ATTITUDE  ANGLES 
TRANSFORMATION 
MATRIX 

TRANSFORMATION 
MATRIX  FROM 

THE  AIRCRAFT 
FRAME  TO  THE 
PLATFORM  FRAME 

— 

TRANSFORMATION 
MATRIX  FROM  THE 
PLATFORM  FRAME 

TO  THE  LOCAL  GEO¬ 
DETIC  FRAME 

GIMBAL 

ANGLES 

WANDER 

ANGLE 

Figure  1-4.  KT-73  Navigation  Computations  of  Attitude  - 

Functional  Block  Diagram 

4  LN-15  Inertial  Navigation  Computations 

1.4.1  General 

The  LN— 15  series  INS,  manufactured  by  Litton,  is  used  in 
various  military  and  civilian  aircraft  including  high  performance 
fighter-bomber  aircraft.  The  IMU  contains  a  four-gimbal  platform 
series  P-500,  The  platform  employs  two,  two-degree-of-freedom 
gyros,  series  G300G2,  with  one-degree-of-freedom  of  one  gyro 
caged.  Three  torque-restrained,  pendulum-type  accelerometers, 
series  A200D,  mounted  on  the  platform  are  used  to  measure  the 
specific  force.  Most  of  the  LN-15  series  INS  employ  the  LC-72B 
computer . 

l^finition  of  the  axes  frame  used  in  the  navigation  confu¬ 
tations  is  not  the  same  for  all  the  LN-15  series  INS.  This  sec¬ 
tion  presents  the  LN-15  navigation  computations  described  in  an 
Intermetrics,  Inc.  report 
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1.4.2  Coordinate  Frames 


(4) 

The  frames  used  during  the  navigation  computations  of 
the  position  and  the  velocity,  shown  in  Figure  1-5,  are  the 
earth  centered  frame,  X,  Y,  Z,  and  the  local  vertical  geodetic 
wander-azimuth  frame,  x,  y,  x.  The  x,  y,  z  frame  coincides  with 
the  computational  frame  and  with  the  platform  reference  frame. 
Note  that  the  LN-15  INS  and  the  KT-73  INS  navigation  computations 
use  the  same  definition  of  the  earth  centered  and  computational 
frames. 

Frame  definition  is  dependent  on  the  software  implementa¬ 
tion.  For  the  LN-15S  used  on  B-1  aircraft  the  frames  are  defined 

(5) 

as  follows  by  Boeing 

The  earth  centered  frame  has  the  x  axis  passing  through  the 
Greenwich  Meridian  and  the  z  axis  along  the  earth  axis  of  rota¬ 
tion.  The  X  axis  is  positive  through  the  Greenwich  Meridian  and 
the  z  axis  is  positive  through  the  North  Pole.  The  platform 
reference  frame,  coincident  with  the  computational  frame  has  the 
z  axis  along  the  local  gravity  vector  and  the  angle  between  x 
axis  and  the  North  is  the  wander  angle,  a.  The  positive  direc¬ 
tion  of  the  z  axis  is  up  and  the  positive  direction  of  the  x  axis 
for  a  =  0,  is  North.  The  wander  angle,  a,  is  defined  to  be  posi¬ 
tive  counterclockwise  from  North. 

1.4.3  Position  and  Velocity  Computations 

•  The  LN-15  navigation  computations  are  performed  in  a 
local-vertical,  geodetic,  wander- azimuth  frame. 

•  The  duration  of  a  basic  iterative  cycle  is  1/16  second. 

•  The  navigation  coii:5)utations  use  a  direction  cosine  matrix, 
C,  representing  the  coordinate  transformation  from  the 
computational  frame,  to  the  earth-fixed  frame.  Only  six 
matrix  terms  (out  of  nine  total)  are  computed. 

•  The  vertical  channel  computations  en^loy  a  third-order 
damping  system. 
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•  The  gravity  computations  in  the  gravity  model  are  repre¬ 
sented  by  the  following  equation. 

—3  2  -7  2 

g  =  -32.0881576  (1  +  5.2888  x  10  sin  L  -  0.955  x  10  h)  ft/sec 

where  L  is  the  geodetic  latitude  and  h  is  the  altitude 

computed  in  the  vertical  channel. 

The  navigation  computations  of  position  and  velocity  are 
represented  by  the  KT-73  flow  diagram  shown  in  Figure  1-3.  Note 
that  the  KT-73  and  the  LN-15  INS  navigation  con5)utations  are 
represented  by  the  same  functional  flow  diagram,  but  the  compu¬ 
tations  employ  different  symbology. 

1.4.4  Attitude  Computations 

The  LN-15  attitude  computations  have  the  same  form  as  the 
KT-73  attitude  computations  described  in  section  1.3.4.  Defini¬ 
tion  of  the  axes  frames  used  in  the  LN-15  attitude  computations 
is,  however,  not  the  same  as  in  the  KT-73  attitude  computations. 

1.5  H-386  Inertial  Navigation  Computations 

1.5.1  General 

H-386  is  a  designation  for  a  member  of  a  family  of  Honey¬ 
well-designed  and  built  aircraft  inertial  navigation  systems 
(INS) .  Some  applications  are  classified;  others  are  for  aided 
system  demonstrations  including  star  tracker,  satellite  and 
Doppler  aiding.  The  basic  INS  consists  of  the  inertial  measure- 
ing  unit  (IMU) ,  the  inertial  electronics  unit  (lEU) ,  the  control 
and  display  unit  (CDU)  and  the  digital  computer. 

A  Honeywell  Mark  III  computer  provides  the  navigation  and 
steering  information,  plus  discrete  and  analog  outputs,  to  other 
aircraft  avionics  systems.  The  prime  inputs  from  other  avionics 
systems  are  barometric  altitude,  reference  position  and.  Greenwich 
mean  time  (GMT) .  The  computer  is  a  24-bit,  fixed-point,  drvrni 
memory  unit. 
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The  IMU  is  a  three-giinbal  platform,  employing  three-single- 
degree-of -freedom,  gas  bearing,  rate-integrating  gyros  (GG159) 
and  three  single  axis,  flexipivot,  hinged  pendulum  accelerometers 
(GG177) .  Both  gyros  and  accelerometers  are  pulse-rebalanced 
providing  direct  digital  outputs. 

The  platform  stabilization  is  local-geocentric  vertical, 
free-azimuth.  A  north-slaved  azimuth  mode  is  available  for  fixed 
base  testing.  A  two  accelerometer  mechanization  is  employed- 
altitude  being  supplied  by  the  barometric  altimeter. 

This  section  describes  the  navigation  computations  of 
position,  velocity  and  wander  angle  in  the  two  accelerometer, 
barometric  altitude,  pure-inertial  mode  based  on  internal  Honey¬ 
well  docvimentation^^^  '  . 

1.5,2  Coordinate  Frames 

Several  coordinate  frames  are  employed  in  the  H-386  naviga¬ 
tion  system  mechanization;  these  are  the  platform  coordinates, 
the  geocentric  latitude  and  longitude  frame,  the  geodetic  lati¬ 
tude  and  longitude  frame,  and  an  earth-fixed,  rectangular 
coordinate  frame  with  the  origin  at  the  center  of  the  earth. 

The  platform  coordinate  frame  has  its  origin  at  the  center 
of  the  optical  cxJae  on  the  azimuth  block.  The  x,  y,  and  z  axes 
are  defined  as  the  normals  to  the  theoretical  cube  faces.  This 
coordinate  frame  is  maintained  so  that  the  z  axis  is  pointed 
toward  the  geocentric  center  of  the  earth.  The  x axis  is  related 
to  north  by  a  rotation  about  z  through  the  angle,  as  shown 

in  Figure  1-6.  Acceleration  measurement  and  gyro  torquing  are 
done  in  this  coordinate  frame.  INS  velocity  is  also  computed  in 
this  coordinate  frame. 

The  geocentric  latitude-longitude  frame  is  related  to  the 
xyz  frame  by  the  angle,  'l^p*  The  INS  position  is  computed  in  this 
coordiate  frame.  The  position  is  then  e;^ressed  in  the  geodetic 
latitude-longitude  frame.  The  geodetic  frame  is  related  to  the 
geocentric  latitude-longitude  frame  by  a  rotation  about  the  east/ 
west  axis  of  0^^/  as  shown  in  Figure  1-7. 
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NORTH 


Figure  1-7.  Relationship  Between  Geocentric 
and  Geodetic  Latitudes 
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For  computations  of  steering  and  course  selection,  it  is 
convenient  to  express  the  INS  position  in  terms  of  the  direction 
cosines  of  the  vector  from  the  center  of  the  earth  to  present 
position.  In  Figure  1-7,  OP  is  this  vector.  The  coordiante 
frame  in  which  these  direction  cosines  are  expressed  has  its 
origin  at  the  center  of  the  earth,  the  i  axis  is  directed  along 
the  earth's  rotational  axis,  the  j  axis  lies  in  the  equatorial 
plane  at  longitude  =  0  (the  Greenwich  Meridian)  and  the  k  axis 
lies  in  the  equatorial  plane  at  longitude  =  E90°.  The  direction 
cosines  of  OP  in  this  frame  are: 

=0  sin 

X-  =0  cos  L.  cos  L 

2  t  g 

X_  =0  cos  L.  sin  L 

3  t  g 

where  is  the  geocentric  latitude  and  is  the  longitude. 
Relations  between  the  geodetic  latitude,  and  the  geocentric 
latitude,  L^,  shown  in  Figure  1-7,  are  given  by: 

where 

-3  . 

=  3.367005  X  10  rad  =  11.575  arc-minutes 

1.5.3  Position  and  Velocity  Computations 

Two  mechanizations  for  the  velocity  and  position  computa¬ 
tions  have  been  employed  with  this  system. 

In  the  first  (and  earlier)  mechanization  the  platform  is 
stabilized  in  geocentric-vertical,  free-azimuth  frame  (no  torque 
other  than  drift  compensation,  is  applied  to  the  azimuth  axis 
gyro) .  The  inertial  angular  velocities  of  the  platform  level 
axes,  WjQy,  are  resolved  through  the  wander  angle,  4)^, 

between  the  platform  x  axis  and  the  north  direction,  into  the 
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components  along  the  geocentric,  local-vertical,  north-pointing, 
computational  frame.  The  latitude  and  the  longitude  rates  L. , 

•  "C 

Lg  are  then  computed  and  integrated. 

The  problem  of  dividing  the  computed  term  (fi  +,  L^)  cos 

by  cos  is  recognized  by  carrying  1/cos  and  the  resulting 

(n  +  L  )  in  double  precision.  If  computations  determine  that  the 
y 

INS  is  passing  exactly  over  one  of  the  poles  an  overflow  will 
occur. 


The  wander  angle. 


is  computed  from 


+ 


0)  At  + 
e 


L  +  L 


% 


'n 


^n-l 


At 


sinL^ 


The  geocentric  latitude,  L^,  is  converted  to  geodetic  lati¬ 
tude,  L^,  only  for  display. 

The  second  (and  later)  mechanization  computes  and 

the  same  as  the  first  mechanization,  but  then  defines  the  platform 
to-inertial  reference  frame  transformation  by  a  matrix  A  consist¬ 
ing  of  elements 

Position  information,  L^,  L^,  and  ip^,  is  used  in  computation 
of  A,  which  is  updated  by  integrating  A  =  A(^,  where  (2  is  the  skew 
symmetrix  matrix  form  of  aTj^,  and  =  ^“lOx'  “lOy'  ^  first 

order  direction  cosine  update  is  employed  to  form 


A  —  A  .  t  A  ■» 
n  n— 1  n-1 


fiAt 


Direction  cosines  of  the  position  vector  relative  to  the 
center  of  the  earth  are  given  by 


X 

1 

-^13 

^2 

=Z  (cOgt) 

■^23 

-  ^3  - 

-"^33  - 
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L.  /  L  and  ij)  are  obtained  from  the  appropriate  inverse  trigono- 

L>  ^  ^ 

metric  functions,  viz: 


The  geocentric  level  conponents  of  earth  relative  velocity, 
Vg  and  Vj^,  are 

^  (“lOx  “  “lOy  -  “e 

=  R  (“loy  +  “lOy  ) 

where 

^lOx'  ^lOy  level  components  of  the  vehicle  angular 

rates  with  respect  to  the  inertial  frame  expressed  in  the  platform 
coordinates.  For  wander  angle,  -  0,  the  x  platform  axis  is 
pointing  north  and  the  y  platform  axis  is  pointing  east. 

The  "gravity"  model,  geocentric  north  and  radial  components, 
gjj  and  g^,  are 

g^j  =  -0.010489  sinL^  cosL^  ( ft/sec)  ^ 

g^  =  32.199497  +  1.847  x  lO"^  sin^L^  -  0.262  x  10"^h 

-  20925738  /  ^  2^  ,2 

\  lOx  ^  lOy  J  (ft/sec) 
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A  functional  flow  diagram  for  the  latter  mechanization  is 
shown  in  Figure  1-8. 

Navigation  computations  are  performed  in  double  precision, 
fixed  point  arithmetic  (component  condensation  is  single  preci¬ 
sion}  .  Attitude  per  se  is  not  extracted  in  the  unaided  naviga¬ 
tion  mode. 

1.6  CAROUSEL-IV  Inertial  Navigation  Computations 
1. 6. 1  General 

The  Carousel-IV  inertial  navigation  system  INS  is  manufac¬ 
tured  by  the  Delco  Electronics  Division  of  General  Motors,  for 
navigation  and  steering  of  long  range,  commercial  aircraft.  The 
INS  is  comprised  of  the  following  units: 

The  Navigation  Unit  containing  the  inertial  platform  and 
associated  electronics,  the  digital  computer,  the  Control/Display 
Unit,  the  Mode  Selector  Unit  and  the  Backup  Battery  Unit. 

The  computer  provides  navigation  and  steering  information 
during  flight  (plus  calibration  and  alignment  during  preflight) . 

A  variety  of  digital  and  analog  inputs  and  outputs  are  available 
depending  on  the  application.  The  computer  is  a  serial,  binary 
machine  with  6144-word,  13-bit  core  memory.  Instruction  words 
are  12  bits  plus  parity  bit,  while  data  words  are  24  bits 
including  sign.  Memory  access  time  is  2.6  microseconds. 

The  platform  is  a  four  gimbal  unit  with  the  outer  roll 
gimbal  driven  by  the  inner  roll  resolver  so  as  to  maintain  the 
inner  roll  and  pitch  gimbals  orthogonal.  The  stable  element 
contains  three  single  degree-of-freedom,  floated,  gas-bearing, 
rate-integrating  gyros  (AC651G) ,  and  three,  single  axis,  linear, 
force  rebalanced  accelerometers.  The  stable  element  is  sub¬ 
divided  into  upper  and  lower  halves:  the  upper  half  (the  z  plat¬ 
form)  contains  the  azimuth  gyro,  the  vertical  accelerometer,  the 
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azimuth  gimbal  synchro  and  torque  motor  and  the  synchronous  motor 
which  drives  the  lower  half  Cthe  x-y  platform)  at  a  constant  rate 
(1  rpm)  relative  to  the  z  platform;  the  lower  half  contains  the 
two  level  gyros  and  accelerometers  and  two  gimbal  resolvers. 

The  vertical  accelerometer  output  is  analog  (with  subse¬ 
quent  A/D  conversion)  while  the  level  accelerometer  outputs  are 
digital.  The  azimuth  gyro  is  untorqued  (free-azimuth)  while  the 
level  gyros  are  pulse  torqued  via  20  Hz  pulse-width  modulated 
loops . 

A  second  order  baro-inertial  vertical  channel  is  employed 
with  an  added  digital  first  order,  low-pass  filter  applied  to 
the  barometric  altimeter  input. 

This  section  describes  the  navigation  computations  for 
pure  (baro)  inertial  mode  of  operation,  based  on  documentation^ 
generated  by  Delco  Electronics  Division  of  General  Motors  (then 
at  Milwaukee,  Wisconsin) . 

1.6.2  Coordinate  Frames 

Four  coordinate  frames  are  used  in  the  mechanization  of 
position,  velocity  and  attitude  computations.  The  inertial 
instrument  axes  (platform  axes)  are  designated  x,  y  and  z.  The 
leveling  process  aligns  z  along  the  local  gravity  vector,  and 
X  and  y  rotate  about  the  z  axis  at  a  rate  with  respect  to 
inertial  space  (nominally  1  rpm) .  The  u,  v,  z  frame  is  a  free- 
azimuth  local -vertical  frame  used  as  a  computational  frame  dur¬ 
ing  the  navigate  mode.  The  MNO  frame  is  an  earth-centered, 
earth— fixed,  right-handed  frame  with  N  along  the  earth's  spin 
axis  and  M  and  0  in  the  equatorial  plane  with  the  0  axis  passing 
through  the  Greenwich  Meridian.  These  coordinates  can  most  easily 
be  visualized  by  reference  to  Figure  1-9. 
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1.6.3  Position  and  Velocity  Cbftiputations 

The  Carousel  IV  position  and  velocity  computations  are 
performed  in  a  free-azimuth,  geodetic  vertical  computational 
frame.  The  computations  are  performed  at  three  iteration 
rates : 

1.  The  minor  or  interrupt  loop  performs  incremental  veloc¬ 
ity  resolutions  and  gyro  torquing.  The  minor  loop  itera¬ 
tion  rate  is  50  milliseconds. 

2.  The  intermediate  or  middle  loop  performs  all  horizon¬ 
tal  velocity,  ellipticity,  and  direction  cosine  computa¬ 
tions  in  addition  to  two  autopilot  signals .  The  middle 
iteration  rate  is  200  milliseconds. 

3.  The  remainder  of  the  computation  is  done  in  the  major 
loop  at  an  iteration  rate  of  600  milliseconds. 

At  the  minor  loop  frequency,  20  Hz,  the  level  accelerometer 
AV's  are  transformed  from  the  rotating  x-y  platform  frame  to  the 
free-azimuth  frame  where  they  are  summed  for  four  cycles.  The 
level  gyro  torquing  rate  is  also  updated.  Every  200  milliseconds 
(5  Hz)  the  horizontal  velocity  computations  are  performed  and 
the  incremental  velocity  and  the  computed  velocity  increments 
are  added  to  the  old  velocity.  The  vehicle  rates  are  then  com¬ 
puted  and  the  direction  cosine  matrix  is  updated.  Every  600 
milliseconds  (1  2/3  Hz)  the  position  and  the  "wander"  angle  are 
extracted  from  the  direction  cosine  matrix,  the  vertical  channel 
computations  are  performed,  the  free-azimuth  level  velocities 
are  transformed  to  the  local— vertical  north  frame  and  the  other 
computations  required  for  control  and  display  are  performed. 

The  gravity  computations  employ  the  gravity  model  repre¬ 
sented  by  the  following  equation; 

-"i  2  -7  2 

g  =  32.0881  (1  +  5.2648  x  10  sin  L  -  0.9558  x  10  h)  ft/sec 
z 

where  L  is  the  geodetic  latitude  and  h  is  the  altitude. 
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"Attitude"  computation  of  heading  consists  of  removing  the 
wander  angle  from  the  encoded  gimbal  azimuth  resolver  reading. 
Pitch  and  roll  are  always  available  as  analog  gimbal  resolvers 
outputs  and  are  never  digitized. 

In  summary,  the  "high"  frequency  (minor  loop)  computations 
are  required  only  because  the  level  (x-y)  platform  is  rotating 
at  1  rpm.  The  x-y  platform  is  rotated  at  this  rate  to  average 
out  many  of  the  level  gyro  and  accelerometer  errors.  The  minor 
loop  computations  could  be  performed  at  the  intermediate  loop 
rate  if  the  free-azimuth  platform  were  not  "carouseled" . 

1. 7  SPN/GEANS  Inertial  Navigation  Computations 

1.7.1  General 

The  Standard  Precision  Navigator/Gimbaled  Electrically 
Suspended  Gyro  Airborne  Navigation  System  (SPN/GEANS)  is  a  direct 
descendant  of  the  GEANS  (AN/ASN-101)  high  precision,  aircraft 
inertial  navigation  system,  both  designed  and  manufactured  by 
Honeywell.  GEANS  consists  of  the  Inertial  Measurement  Unit  (IMU) , 
the  Interface  Electronics  Unit  (lEU) ,  the  Digital  Computer  Unit 
(DCU  -  a  Honeywell  HDC-601) ,  and  the  Control  and  Display  Unit 
(CDU) .  For  SPN/GEANS,  the  latter  two  items,  i.e.,  the  DCU  and 
the  appropriate  operator  interface  are  government  furnished 
equipment  (GFE) .  The  GEANS  CDU  HDC-601,  is  functionally  an  air¬ 
borne  equivalent  of  the  Honeywell  DDP-516  with  an  8K  memory  (see 
SIRU  description  in  section  1.8).  For  SPN/GEANS,  the  GFE  DCU  is 
manufactured  by  ROLM.  In  either  case  the  prime  interface  between 
the  IMU  and  lEU,  and  the  CDU  and  other  avionics  subsystems  is 
via  a  serial  data  bus  (SDB) . 

The  IMU  employs  a  four  gimbal,  all  attitude  space-stabilized 
platform.  It  employs  two,  two-degree-of-freedom,  electrically 
suspended  gyros  (ESG)  with  the  redundant  axis  of  one  ESG  caged 
(by  employment  of  redundant  axis  torquing,  RAT) .  Three  single 
axis,  hinged  pendulum,  flexipivot  accelerometers  (GG177)  measure 
specific  force.  Pulse-width  torquing  is  applied  to  the  RAT  axis; 
accelerometer  rebalance  is  via  "bang-bang" ,  hundred  percent  duty- 
cycle  loops. 
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Vertical  channel  (radial)  damping  computation  employs  a 
constant  gain,  second-order  loop.  Doppler  radar  measurements 
(when  available)  are  applied  via  a  Kalman  filter  for  velocity 
damping  and/or  in  air  alignment.  Position  fixes  are  applied  by 
the  same  means. 

This  section  describes  the  navigation  computations  of  posi¬ 
tion,  velocity,  attitude  and  attitude  rate  in  the  pure  baro- 

inertial  mode  of  operation.  The  description  is  based  on  the  SPN/ 

(2) 

GEANS  Cdmputer  Program  Development  Specification  generated  by 

Honeywell  Aerospace,  St.  Petersburg,  Florida. 

1.7.2  Coordinate  Frames 

The  four  primary  coordinate  frames  employed  for  the  navi¬ 
gation  and  attitude  computations  are  the  inertial  reference  frame 
(which  is  the  computational  frame) ,  the  local  (geodetic)  vertical 
north  frame,  the  body  (or  vehicle)  frame  and  the  platform  space- 
stabilized  frame. 

The  computational  frame  (axes  Xq,  yQ,  Zq)  and  the  local 
vertical  geodetic  frame  (axes  x.2'  ^2'  ^2^  shown  in  Figure  1-10 

An  intermediate  frame  (axes  x^,  coincide  with  the  compu¬ 

tational  frame  axes  at  the  start  of  the  inertial  mode  of  opera¬ 
tion,  t  =  0.  As  shown  in  Figure  1-10,  L  is  the  INS  geodetic 
latitude,  AX  is  the  1 1 NS  longitude  change  during  the  flight  and 
0)^  is  the  magnitude  of  the  earth's  angular  velocity  with  respect 
to  the  inertial  space. 

The  vehicle  body  frame  (axes  x^,  y^,  z^)  is  shown  in  Fig¬ 
ure  1-11.  The  vehicle  body  axes  coincide  with  the  local  geodetic 
frame  axes  for  a  leveled  vehicle  with  the  fuselage  pointing 
north. 

The  platform  reference  axes  have  a  fixed  orientation  with 
respect  to  the  computational  frame,  axes. 
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Figure  1-11. 


Vehicle  Frame  Axes  Used  In 
SPN/GEANS  Computations 
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1.7.3  Position  and  Velocity  Computations 


The  SPN/GEANS  position  and  velocity  computations  are  per¬ 
formed  in  the  space-stabilized  computational  frame,  as  shown  in 
Figure  1-12.  The  velocity  increments,  AVq,  sensed  by  the  accel¬ 
erometers  and  resolved  along  the  computational  frame  axes  are 
combined  with  the  gravity  contributions,  GAt,  and  with  the  baro¬ 
metric  damping  term,  kj^Ah.  The  computed  inertial  velocity,  Vq, 
is  used  in  computation  of  the  local  geodetic  velocity  components , 
V2.  The  Vq  is  also  used  with  the  barometric  damping  term,  K2Ah, 
in  the  computation  of  the  inertial  position,  Rq.  The  Rq  is  used 
in  the  gravity  computations,  in  the  geodetic  velocity  computa¬ 
tions  and  in  the  geodetic  position  computations  (latitude,  L, 
longitude,  X,  and  altitude  h) . 

Position  and  velocity  computations  are  performed  every  125 
milliseconds  (8  Hz) . 

1.7.4  Attitude  Computations 

The  SPN/GEANS  attitude  computations  are  shown  in  a  func¬ 
tional  block  diagram.  Figure  1-13.  THe  attitude  angles  are  com¬ 
puted  by  solving  the  following  matrix  equation: 

Attitude  angles  matrix  -  Transformation  matrix  from  the  vehicle 

body  axes  to  the  geodetic  axes 

The  attitude  angles  matrix  is  a  function  of  the  vehicle 
yaw,  pitch  and  roll  angles. 

The  transformation  matrix  from  the  vehicle  body  axes  to  the 
geodetic  axes  consists  of  the  transformation  from  the  vehicle  body 
axes  to  the  platform  axes  followed  by  the  transformation  from  the 
platform  axes  to  the  geodetic  axes.  The  former  transformation  is 
determined  from  the  gimbal  angles;  the  latter  from  the  computed 
position  and  time  of  the  inertial  mode  of  operation. 

The  attitude  computations  are  performed  every  31.25  milli¬ 
seconds  (32  Hz) . 
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.  Figure  1-12.  SPN/GEANS  Position  and  Velocity  Computations 
Functional  Block  Diagram 
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Figure  1-13.  SPN/GEANS  Attitude  Computations 
Functional  Block  Diagram 
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1.8.1  General 


H-429  is  a  designation  for  a  member  of  a  family  of  Honey¬ 
well  designed  and  built  strapdown  inertial  navigation  systems, 
which  was  used  in  the  SIGN  III  Kalman  Inertial  Doppler  System 
flight  tests  at  Holloman  Air  Force  Base  during  1970  -  1971  period. 

The  INS  uses  the  SIGN  III  computer,  manufactured  by  Honey¬ 
well  to  perform  the  attitude,  navigation  and  Doppler/Inertial/ 
Checkpoint  Kalman:  filter  computations  for  the  system  as  well  as 
driving  the  recorders  and  printers  for  in-flight  and  post— flight 
evaluation.  The  primary  external  input  required  for  the  naviga¬ 
tion  function  is  barometric  altitude.  The  computer  is  a  4096- 
word,  20-bit,  fixed-point,  twos  complement,  machine  with  a  2-micro¬ 
second  cycle  time. 

The  IMU  consists  of  a  strapdown  block  containing  three, 
one-degree-of-f reedom,  gas  bearing  gyros  (GG334)  and  three 
single  axis,  flexipivot,  hinged  pendulum  accelerometers.  The 
inertial  components,  all  of  Honeywell  manufacture,  are  pulse- 
rebalanced  at  3.6  kHz;  they  have  a  high  angular  rate  and  high  g 
capability  compatible  with  high  performance  aircraft  applications. 

The  input  axes  of  the  inertial  s:ensors  nominally  coincide 
with  the  aircraft  body  axes.  Navigation  computations  are  per¬ 
formed  in  a  geocentric  vertical  north  pointing  frame,  hence  the 
system  is  not  suitable  for  use  in  the  immediate  vicinity  of  the 
earth's  poles.  The  barometeric  altimeter  is  incorporated  into  a 
constant  gain,  second  order,  baro-inertial  (geocentric)  vertical 
channel.  Doppler  velocities  and  checkpoint  fixes  are  incorporated 
into  the  system  via  the  Kalman  filter. 


This  section  describing  the  navigation  computations  for  the 
pure  (baro-inertial)  mode,  is  based  on  internal  Honeywell  docu¬ 


mentation 


(10) (11) 
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1.8.2  coordinate  Fraines 


This  section  describes  the  fraines  used  in  the  navigation 
computations  of  position,  velocity,  and  attitude. 

The  frames  used  in  the  above  computations  are  the  body 
(aircraft)  or  platform  frame  and  the  geocentric  local  vertical 
north  pointing  frame.  The  x-axis  of  the  body  frame  is  towards 
the  belly,  the  y-axis  is  towards  the  nose  and  the  z-axis  is 
towards  the  right  wing.  The  geocentric  local  vertical  north 
pointing  frame  has  the  x-axis  towards  the  center  of  the  earth, 
the  y-axis  is  north  in  the  geocentric  level  freime,  and  the  z-axis 
is  east.  This  is  the  computational  frame. 

The  transformation  from  the  body  frame  to  the  computational 

c 

frame  represented  by  the  attitude  matrix,  Cj^  ,  is  given  by: 

Cj3  =  X  ^  (’®Gc)  y 

The  attitude  angles,  0^^,  defined  with  respect  to  geo¬ 

centric  frame,  differ  from  those  defined  relative  to  the  geodetic 
vertical  by  up  to  3.3  milliradians  at  45°  latitude. 

1.8.3  Position  and  Velocity  Computations 

•  The  H-429  inertial  navigation  computations  are  performed 
in  the  geocentric  local  vertical,  north -pointing  frame. 

•  The  basic  navigation  and  attitude  matrix  update  computa¬ 
tional  cycle  is  20  milliseconds  (50  Hz) . 

The  attitude  matrix  update  employs  a  second  order  quater¬ 
nion  update  algorithm  using  the  "total  A6"  method,  described  in 
Section  2,  and  conversion  to  the  direction  cosine  matrix  form. 

The  angular  velocities  computed  are  the  inertial  angular 
velocities  of  the  vehicle  in  the  computational  frame  (inertial 
velocities  expressed  in  the  computational  frame) . 
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In  computation  of  the  east  component  of  the  aircraft  veloc¬ 
ity  with  respect  to  the  earth,  the  earth’s  inertial  velocity  is 
subtracted  from  the  computed  total  inertial  angular  velocity^  The 
aircraft  north  and  vertical  components  of  velocities  with  respect 
to  the  earth  are  computed  in  the  geocentric  frame  with  no  conver¬ 
sion  to  the  geodetic  frame. 


Latitude  and  longitude  are  obtained  by  integrating  the 
angular  rates.  Latitude  is  converted  to  the  geodetic  frame  for 
display.  The  "gravity”  model  used  contains  the  geocentric  north 
and  vertical  components  of  the  mass  attraction.  The  equations 


y  3J^  sinX  cosX 


where  the  constants,  y  and  are 

y  =  1.407654  x  10^®  ftVsec^ 

J2  =  1.0828  X  10“^ 

and  _ 

=  2,0925738  x  10  ft 

R  is  the  computed  present  geocentric  radius  to  vehicle  (ft)  and 
X  is  the  computed  present  geocentric  latitude. 

R  is  initialized  from 


where  o*s  as  subscripts  denote  initial  values  and  e  =  1/298.3,  and 

H  is  the  initial  barometric  altitude.  Thereafter  R  is  computed 
o 

from 
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where  Vjj(t)  is  the  computed  geocentric  vertical  velocity  at  time  t. 

Note  that  in  equations  of  R  -  =  H  -  H^,  the  variation  in  R  as 

a  function  of  latitude  for  a  constant  barometric  altitude,  H^, 
is  not  taken  into  account.  As  a  result  an  altitude  reference 
error  of  the  order  of  (sin^X^  —  sin  X)  will  occur  at  the 

input  to  the  second-order  vertical  damping  loop. 


SIRU  Inertial  Navigation  Computations 


1.9.1  General 

SIRU  is  the  acronym  for  the  Strapdown  Inertial  Reference 
Unit,  designed  and  built  by  CSDL  under  contract  to  NASA/MSC.  It 
is  a  redundant  modular  instrument  package  developed  to  achieve 
and  investigate  high  reliability  guidance  and  navigation  concepts. 

For  fixed  based  tests,  the  SIRU  is  interfaced  with  a  Honey¬ 
well  DDP-516  digital  computer  with  a  16K  (16,384-word)  core  memory 
plus  two  discs.  For  the  current  flight  test  program,  SIRU  uses  a 
(jual,  ruggedized,  Honeywell  DDP— 316  installation,  each  with  a  12K 
(12,288-word)  core  memory.  Both  con^uters  are  16-bit,  fixed  point, 
twos  complement  machines;  the  prime  operational  difference  is  the 
memory  cycle  time  of  0.96  microsecond  for  the  DDP-516  and  1.72 
microseconds  for  the  DDP— 316  computers. 
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The  instrument  package  contains  six  single-degree-of-free- 
dom,  floated,  gas  bearing,  rate-integrating  gyros  (size  18,  model 
B,  IRIG)  operating  in  a  pulse- torqued  mode,  and  six  single  axis, 
floated-pendulous  accelerometers  (16  PM,  PIPA)  operating  in  a 
9.6  kHz  pulse-on-demand,  pulse-rebalance  mode.  The  input  axes 
are  each  normal  to  one  face  of  a  regular  dodecahedron,  but  are 
packaged  in  prealigned  modules  permitting  simple  installation  in 
a  rectangular  shaped  frame. 

From  the  redundant  sensors  an  equivalent  orthogonal  triad 
is  defined  and  used  in  navigation  computations.  A  second  order, 
constant  gain,  baro-inertial  vertical  channel  is  employed  with 
the  altitude  set  to  10,000  feet. 

This  section  describes  the  navigation  computations  of  posi¬ 
tion  and  velocity  in  the  pure-inertial  mode.  Attitude  angles 
are  not  extracted.  The  description  is  based  on  reports  generated 
at  CSDL  , 

1.9.2  Coordinate  Frctmes 

The  coordinate  frames  used  in  position  and  velocity  compu¬ 
tations  in  the  navigation  mode  are  defined  in  this  section. 

The  equivalent  orthogonal  sensor  triad  is  nominally  paral¬ 
lel  to  the  vehicle  or  body  frame.  The  x-axis  is  parallel  to  the 
vehicle  yaw  axis  -  positive  up.  The  y-axis  is  parallel  to  the 
vehicle  pitch  axis  -  positive  towards  the  right  wing.  The  z-axis 
is  parallel  to  the  vehicle  roll  axis  -  positive  forward. 

The  "local -level"  computational  frame  employed  for  the 
navigation  computations  is  geodetic . vertical ,  north  pointing. 

The  body  and  computational  frames  coincide  for  a  vehicle  geodeti-< 
cally  leveled  heading  north.  The  x-axis  of  the  computational 
frame  is  directed  along  the  geodetic,  vertical  -  positive  "up". 

The  y-axis  is  tangent  to  the  meridian  positive  north. 

It  should  be  noted  that,  while  the  two  frames  defined  above 
are  the  same  as  the  frames  employed  in  the  H-429  (SIGN  III)  navi¬ 
gation  computations,  described  in  section  1.8,  the  axes  are  re¬ 
arranged,  as  inevitably  seems  to  be  the  case. 
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case  IS 


c  •  •  ■ 

The  body  to  computational  frame  transformation  Cj^  in  this 

C?  =  xm  y(-0) 


where  the  geodetic  attitude  angles  are ,  iIj  ^  6 ,  'P  . 

1.9.3  Position  and  Velocity  Computations 

The  SIRU  inertial  navigation  computations  are  perfomred  in 
a  local  geodetic  vertical,  north-pointed  frame.  This  renders  the 
system  unsuitable  for  use  in  the  immediate  vicinity  of  the  earth  s 
poles. 

In  SIRU  navigation  computation  the  radii  of  curvature, 
meridional  and  prime  vertical,  r^^  and  r^  are  given  by: 

2 

r  =  r  (  1  -  2e  cos  L) 
m  o 

and  =  r^  (1  +  2e  sin^L) 

where  "^o  "  "^e  ®  sin^L) 

and  r  is  the  sea  level  radius  from  the  center  of  the  earth  to  the 

o 

present  position. 

r^  is  the  equatorial  sea  level  radius  (6378163  meters) 
e  is  the  ellipticity  of  the  meridional  ellipse  (1/297) 

L  is  the  geodetic  latitude 

•  • 

Latitude  and  longitude  rate,  L  and  1,  are  given  by 

=  -V(^m  + 

i  =  Vg/(rp  +  h)  cosL 
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where  and  are  the  east  and  north  components  of  the  aircraft 
velocity  with  respect  to  the  earth.  The  attitude  matrix. is 
updated  every  20  milliseconds  C50  Hz)  using  the  "total  A9"  method 
and  third  order  quaternion  update  algorithm  and  normalization 
similar  to  that  described  in  section  2.  After  conversion  to 
the  direction  cosine  matrix  form,  the  updated  matrix  is  used  to 
transform  the  AV's  accumulated  over  a  20  millisecond  period  to 
the  local  vertical  frame  to  update  the  V.  The  AV  and  A0  accu¬ 
mulation  times  are  staggered  so  that  the  matrix  values  are  appro¬ 
priate  to  the  midpoint  of  AV  interval. 

The  position  and  velocity  computations  are  performed  at  a 
1  Hz  rate  and  are  earth  relative  (rather  than  inertial  relative 
as  was  the  case  for  SIGtN  III)  and  h  is  an  externally  supplied 
altitude  (set  to  10,000  feet  for  flight  test).  Since  the  vertical 
channel  does  not  supply  altitude  but  only  altitude  rate,  h,  to  the 
inertial  computations,  the  gravity  model  is  of  lesser  importance 
and  only  a  constant  vertical  component  of  gravity  is  used. 

No  attitude  computations  are  performed  in  the  SIRU  mechan¬ 
ization. 
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SECTION  2 

DETAILED  NAVIGATION  EQUATION  STRUCTURE 

2 . 1  Introduction 

This  section  presents  the  equations  which  are  mechanized  in 
the  navigation  computer  portion  of  the  numerical  simulator  for 
any  of  a  local  vertical  wander  azimuth  (LVWA) ,  a  space  stable  (SS) , 
or  a  strapdown  (SD)  IMU.  While  computational  flow  diagrams  are 
included  for  both  inertial  (SS)  and  LVWA  computational  frames, 
only  the  LVWA  navigation  algorithm  is  developed  in  detail  since 
this  is  the  "selected"  computational  frame  (see  Section  5  of  this 
volvraie) .  Another  area  requiring  some  exposition  is  the  strapdown 
computations,  which,  again,  are  developed  in  detail  only  for 
use  with  a  LVWA  computational  frame.  Similarly,  the  attitude 
predictor  filter  is  described  ip  some  detail.  The  remainder, 
consisting  mainly  of  transformations,  are  referred  to  and  relegated 
to  the  Appendices. 

2.2  Navigation  and  Attitude  Computations 

2.2.1  General 

The  navigation  and  attitude  computations  for  all  three  INS 
types  and  either  computational  freume  naturally  subdivide  into 
three  gross  modules: 

(1)  Transformation  (T) 

(2)  Navigation  (N) 

(3)  Attitude  (A) 
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2.2.2 


Tranformation  and  AV  Accumulation 


The  function  of  the  first  module,  T,  is  the  generation  of 
the  orthogonal  transformation  from  the  platform  (P)  frame  to  the 
computational  (C)  frame  and  the  subsequent  transformation  of  the 
incremental  velocities  accumulated  over  one  sampling  interval, 
At,p,  from  the  platform  frai';'"  to  the  computational  frame.  Reduced 
to  simplest  terms,  it  mechanizes  the  "equations”. 

(a)  Generate  Cp 

(b)  ^  °  =  C° 

Depending  on  the  nature  of  the  platform  frame  incremental 

P 

velocities,  Av^,  may  be  transformed  from  the  platform  frame  to 
the  computational  frame  more  often  than  once  per  navigation 
computational  cycle,  in  which  case  the  ratio,  At^/At^  =  2^, 

where  m=l,2,3,--*-  An  additional  function  is  defined  in 
this  case,  i.e.,  the  summation  of  the  incremental  velocities 
in  the  computational  frame. 


(c) 


E 

i=l 


For  a  LVWA  INS  using  a  LVWA  computational  frame,  the  platform  (p) 

Q 

frame  and  the  computational  (c)  frame  are  identical,  i.e.,  Cp  =  I, 

and  neither  of  steps  (a)  or  (b)  is  required.  If  the  sampling  inter 

val  is  less  than  the  navigation  computational  cycle  it  would  be 

'  *  s 

necessary  to  svim  ^  as  indicated  in  step  (c)  . 
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For  a  SD  INS  using  a  LVWA  computational  frame,  the 
platform  (p)  frame  is  the  body  (b)  frame.  The  transformation 
required  is  C^,  which  is  generated  as  indicated  in  Section 
2.3.3,  the  section  on  strapdown  computations. 

For  a  SS  INS  using  a  LVWA  computational  frame,  the  plat¬ 
form  frame  is  related  to  the  coir^utational  frame  by  a  trans¬ 
formation  which  is  expressed  as  the  product  of  three  rotation 
matrices,  viz: 

C°  =  C°  cf 
p  e  i  p 

In  the  present  study,  the  platform  to  inertial  frame  transforma¬ 
tion,  C^,  is  a  constant  since  the  platform  is  considered  to  be 
P 

non-drifting.  is  supplied  by  the  initial  conditions. 

P 

The  transformation  from  the  inertial  (i)  to  the  earth  fixed 

(e)  frame,  C?,  is  a  single  axis  rotation,  Z  (u.  t) .  It  accounts 

for  the  rotation  of  the  earth  from  the  start  of  navigation  until 

the  start  of  the  present  navigation  computation  cycle.  Its  initial 

value  is  I.  The  transformation  from  the  earth  fixed  (e)  frame 

to  the  computational  (c)  frame  is  the  transpose  of  the  "direction 

cosine"  matrix  computed  in  the  LVWA  navigation  algorithm  and  is 

appropriate  for  the  start  of  the  present  navigation  cycle,  but 

c 

uses  the  "gyro  torquing"  signals  to  extrapolate  to  the  middle 
of  the  navigation  computational  cycle. 
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To  minimize  the  computations  required,  the  incremental 

velocities  in  the  SS  platform  frame  are  premultiplied  successively 

i.  6  c 

by  each  of  the  three  individual  rotation  matrices,  Cp,  C^,  to 

C  .  •  " 

obtain  Av  .  This  operation  requires  three  matrix-by-vector 

Q 

multiplications  or  27  multiplies  and  18  adds,  whereas  forming  C 
from  three  matrices  and  then  transformat ing  Av^  requires  63 
multiplies  and  42  adds. 

The  sequence  of  matrix  and  vector  operations  is  indicated 
in  the  computational  flow  diagrams  for  the  three  INS  types  with 
a  LVWA  computational  frame  (Figures  2-1,  2-2,  2-3a,  and  2-3b) . 

The  corresponding  transformation  operations  for  the  three 
INS  types  with  a  SS  computational  frame  are  indicated  in  the 
computational  flow  diagrams  (Figures  2-4,  2-5  and  2-6).  In 
increasing  order  of  complexity  of  transformation,  the  systems 
rank  SS,  SD  and  LVWA. 
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2.2.3  Navigation 

The  function  of  the  second,  N,  module  is  to  generate  the 
geodetic,  local  vertical,  north-pointing,  velocity  and  position 
components  from  the  incremental  velocity,  and  the  initial 

conditions.  A  non- inertial  altitude  indication,  generally  baro¬ 
metric  altitude, is  also  required.  These  operations  are  embodied 
in  the  Navigation  Algorithm  with  Vertical  Damping  and  the  Output 
Conversion  NAVD/OC.  The  routines  included  in  the  NAVD/OC  are 
tabulated  in  Tables  2-1  and  2-2. 

With  a  LVWA  computational  frame,  the  outputs  not  only 

include  the  LVN  position  and  velocity  but  also  the  wander  angle,  a, 

c 

and  the  gyro  torquing  signals, All  indicated  computations 
are  performed  for  all  three  INS  types.  The  individual  routines 

are  outlined  in  Table  2-1- 

With  a  SS  computational  frame,  the  outputs  are  LVN 

a 

position,  velocity,  and  inertial-to-LVN  transformation,  (or 

Cq) .  The  individual  routines  are  outlined  in  Table  2-4. 

Wander  angle  and  gyro  torquing  signals  are  required  only  for  a 
LVWA  INS.  Special  computations  required  for  the  above  system 
also  contribute  to  the  generation  of  the  transformation  from  the 
(LVWA)  platform  frame  to  the  computational  (inertial  frame)  as 
required  for  the  first  (T)  module. 
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2.2.4 


Attitude 


The  function  of  the  third,  A,  module  is  to  generate  the 
attitude  (roll,  pitch,  heading)  angles  of  the  vehicle. 

With  the  LVWA  computational  frame  the  readily  available 
transformation  is  that  from  the  body  frame  to  the  computational 

frame,  C^.  As  indicated  in  Appendix  4.4.7  this  is  not  quite 

0 

the  attitude  matrix,  Cj^,  but  differs  from  it  only  to  the  extent 
that  the  heading  "extracted"  from  this  matrix  is  ('F-a)  .  This 
is  shovm  in  the  computational  flow  diagrams  Figures  2-1,  2-2, 
and  2-3b. 

With  the  SS  computational  frame ,  the  body-to-LVN  trans- 
formation,  is  generated  directly  from  gimbal  angles  (as  was 

the  case  with  a  LVWA  computational  frame)  and  the  "attitude¬ 
like”  angles  are  extracted  as  before;  "heading"  is  corrected  by 
the  addition  of  the  wander  angle — see  Figure  2-5. 

Attitude  will  be  computed  at  the  same  frequency  as  the 
navigation  computations  or  at  some  binary  multiple  of  the  naviga¬ 
tion  frequency.  In  the  latter  case,  it  may  be  necessary  to 
extrapolate  the  inertial-to-LVN  transformation  or  the  wander  angle. 
Regardless  of  the  computational  frame,  the  three  steps  in  attitude 
computation  and  filtering  are: 

1.  Form  (or  cg) 

2.  Extract  "attitude"  angles  (correct  heading  if  necessary) 

3.  Filter  and  predict  attitude 

The  attitude  filter-predictor  will  be  described  in  Section  2.5.5. 
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Table  2-1.  Local  Vertical  Wander  Azimuth  Navigation  Algorithm  with  Vertical 
Damping 

1  Update  platform  frame  velocities, 

2  Add  vertical  damping  terms. 

3  Compute  angular  velocities  about  level  axes. 

4  Update  direction  cosine  matrix  (opt.  2nd  order). 

5  Orthonormalize  direction  cosine  matrix  (1st  order). 

6  Compute  earth's  rate  signals  (angles). 

*  7  Compute  gyro  torquing  signals. 

8  Compute  angular  velocity  [for  (cjxv)]. 

9  Compute  (c3xv)  At  terms  (for  velocity). 

10  Compute  altitude  and  vertical  damping. 

1 1  Compute  gravity  components. 

*12  Extract  position  and  wander  angle. 

*13  Form  wander  angle  matrix  and  LVN  velocities. 


*Shown  as  separate  blocks  In  computational  flow  diagrams. 
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LV  WA  NAVIGATION  COMPUTATIONS 
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LVWA  Computationa 


•IMO  COMPUTATIONS  -  INSERTED  TO  EMPHASIZE  FOR  USE  OF  c"  FROM  PREVIOUS 
HIGH  SPEED  COMP.  CYCLE. 

Figure  2-3a.  High  Speed  Computational  SD  System-LVWA  Navigation 

Frame 
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-3b.  Strapdov/n  INS  Computational  Flov;  Diagram  with  LVWA 

Computational  Frame.  Navigation  and  Attitude  (Low  Speed) 

Computations 


Table  2-2.  Space  Stable  Navigation  Algorithm  with  Vertical  Damping  —  Subtracting 
East  Velocity  of  Earth 

1  Extrapolate  position  to  mid  comp,  cycle. 

2  Compute  mass  attraction 

3  Compute  vertical  damping  for  position  computation 

4  Update  velocity  for  position  computation 

5  Update  position 

6  Update  velocity 

7  Remove  east  velocity  of  earth. 

8  Compute  inertial  and  reference  radii  difference. 

Transformation  to  Local  Vertical  and  Local  Vertical  (North)  Outputs 

9  Compute  latitude  and  longitude 

10  Form  inertial  to  (geodetic)  local  vertical  transformation 

11  Transform  inertial-referenced  velocity  to  local  vertical 
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2.3  Transf oCTiation  and  Increniehtal  Vslocity  Accuniulation 

Some  further  comments  are  required  on  the  "phasing"  of  the 
incremental  velocities,  AV's  and  the  transformation  to  the  LVWA 
computation  frame  in  the  cases  of  the  SS  and  SD  IMU's. 

2.3.1  Local  Vertical  Wander  Azimuth  IMU 

Ideally,  the  platform  of  the  LVWA  IMU  coincides  with  the 
LVWA  computational  frame.  Hence,  the  AV's  are  merely  summed 
over  a  navigation  computation  cycle  and  entered  directly  in  the 
velocity  update  routine  of  the  navigation  algorithm. 

In  practice ,  the  IMU  and  computational  frames  do  not  quite 
coincide  with  each  other  nor  with  true  LVWA  frame,  due  to  gyro  tor- 
quing  errors.  Thus,  the  Av's  from  a  LVWA  IMU  generally  reflect 
the  effects  of  infinitesimal  rotation  from  their  "true"  values. 

The  mechanization  of  the  gyro  torquing  errors  is  a  part  of  the 
LVWA  IMU  simulator  portion  of  the  numerical  simulator . 

2.3.2  Space  Stabilized  IMU 

The  comments  on  the  transformation  of  the  AV's  from  a  SS  IMU 
to  the  LVWA  computational  frame  as  described  in  Section  2.2.2 
are  directly  applicable  to  the  simpler,  or  "baseline"  software 
shown  in  the  computational  flow  diagrams. 

However,  when  the  "upgraded"  navigation  algorithm  is  used, 
an  estimate  of  C®  (or  C®!)  at  the  mid-point  of  the  next  navigation 
computation  cycle  is  generated,  which  obviates  the  necessity  of 
"torquing"  C®  (or  its  transpose)  specifically  for  the  purpose 
of  transforming  the  AV's.  The  inertial  to  earth  fixed  transforma¬ 
tion,  C®  (C°')  must  then  be  computed  at  the  mid-point  of  the 
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computation  cycle  rather  than  at  the  beginning  as  was  formerly 
the  case.  The  equations  mechanized  are  indicated  below: 


the  mid-point  of  the  nth  computational 
cycle 

(or  Cp) is  SS  platform-to-inertial  transformation  or  SS 
alignment  matrix. 

In  this  particular  case,  fewer  computations  are  required  for  the 
transformation  of  space  stable  platform  AV's  to  the  LVWA  frame 
than  for  the  basic  "baseline"  algorithm. 
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2.3.3  Strapdovm  IMU 

The  strapdown  navigation  equations  may  be  mechanized  either 
in  the  space-stabilized  computational  frame  or  in  the  local-level 
computational  frame.  The  mechanization  of  the  navigation  equations 
uses  updating  of  the  transformation  from  the  body  frame  to  the 
computational  frame.  The  body  frame  orientation  is  determined 
by  aircraft  attitude  and  high  speed  computations  are  required  to 
update  the  body-to-computational  frame  transformation  in  a 
maneuvering  vehicle. 

For  the  space-stabilized  computational  frame,  the  body-to- 
inertial  frame  transformation  may  be  updated  at  a  higher  rate 
than  the  transformation  from  the  inertial  frame  to  the  local 
vertical  north  frame,  required  for  the  navigation  computations. 

For  the  local-level  computational  f rame, however ,  the  total 
transformation  from  the  body  frame  to  the  local-level  frame  must 
be  updated  at  a  high  rate. 

The  transformation  from  the  body  frame  to  the  computational 
frame  may  be  expressed  by  a  direction  cosine  matrix  or  by  a 
quaternion.  The  quaternion  representation  of  the  transformation 
is  more  commonly  employed  in  the  present  strapdown  (SD)  inertial 
navigation  systems . 

This  subsection  presents  mechanizations  for  a  strapdown 
system  with  a  local-level-wander-azimuth  computational  frame 
which  update  the  entire  body-to-computational  frame  transformation 
in  the  high  speed  loop. 
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2 . 3 . 3 . 1  Strapdovm  Computations  with  Local  Vertical  Wander  Azimuth 

Computational  Frame 

The  (corrected)  gyro  outputs  in  a  strapdovm  system  represent 

the  integral  of  the  angular  rate  (and  derivatives)  of  -the  sensor 

block  with  respect  to  an  inertial  reference  frame  expressed  in 

"  b 

sensor  (body)  coordinates  over  the  sampling  interval,  Mib*  ^ 

measure  of  the  integral  of  the  angular  rate  of  the  computational 
frame  with  respect  to  the  inertial  frame  expressed  in  body 
coordinates,  »  is  available,  then  the  difference  between  the 

two  incremental  angles  approximates  the  integral  of  the  angular 

rate  of  the  body  frame  with  respect  to  the  computational  frame  in  . 

Jd 

body  frame  coordinates,  A0cb- 

Expressing  the  angular  rates  in  vector  form: 


b  ^  b 
0).,  + 

—lb  —Cl 


(a)  •  <  ”•  (a)  • 

—lb  —1C 

03  . ,  -  C  W  . 

—lb  c  —1C 


b  /^c^T  c 

0) . ""  (C-.  )  0). 

—  lb  b  .xc 


(2-1) 


Equation  2-1  ir.  the  instantaneous  angular  velocity  of  the  body 
frame  with  respect  to  the  compi'tational  frame  in  body  coordinate. 
The  quaternion  differential  equation  to  be  integrated  is: 


‘c  1  c  b 
Ik  '  qj, 


(2-2) 


The  corresponding  direction  cosine  matrix  differential  equation  isj 


^b  “  ^b  ^b 


(2-3) 


where  is  the  three  by  three  skew  symmetric  matrix  corresponding 

cb 

to  that  is 
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It  is  necessary  to  integrate  either  Equation  2 -2  or  Equation  2 -3 

c 

to  update  the  body-to-computational  frame  transformation,  Cj^, 
which  is  required  to  transform  the  corrected  accelerometer  outputs 
from  the  body  frame  to  the  computational  frame.  Of  course,  the 
transpose  of  C°  is  also  required  to  transform  from  the  computa¬ 

tional  to  the  body  frame  as  indicated  in  Equation  2-1.  When 
Equation  2-3  is  to  be  used.  Equations  2-1  and  2-4  are  applied 

in  that  order  to  obtain  Equation  C-3. 

In  all  SD  systems  examined  to  date,  is  computed,  once 

per  navigation  cycle,  from 


c  c  .  c 

0)  .  =  W  +  o 

—1C  — ec  — le 


(2-5) 


and  it  is  implicitly  assumed  that  wfc 


tantamount  to  stating  that 

fc>  ^ 

•  b  A  c 
w.  =  0). 

—1C  C  —1C 


(2-6) 


The  difference  equation  corresponding  to  the  integral  of  Equation 
2-1  over  the  high  speed  computation  cycle,  At^^,  is  usually 
expressed  as; 
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e-7) 


where : 


=  «„/K 

K  =  2"^,  m  is  positive  integer 

At  is  the  navigation  computation  cycle 
n 

1  <  N  <  K 

Vl  “ 

^n  "  ^n-1 

The  only,  computational  difference  between  the  high  speed  loop 
for  a  strapdown  system  with  a  SS  computational  frame  and  the  same 
system  with  a  LVWA  computational  frame  is  the  additional  computa¬ 
tions  given  by  Equation  2-1.  The  additional  computation  adds  9 
multiplications  and  9  additions  per  high  speed  computation  cycle. 
The  computational  flow  diagram  for  a  strapdown  (SD)  system  with 
LVWA  navigation  computations  is  shown  in  Figure  2-3.  The  up¬ 
dating  of  directional  cosine  matrix,  shown  in  Figure  2-3,  may 
be  replaced  by  quaternion  updating.  The  quaternion  and  direction 
cosine  matrix  updates  are  discussed  in  section  2. 3. 3. 2. 
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2. 3. 3. 2  Direction  Cosine  and  Quaternion  Update  Algorithm 

The  equations  used  in  generating  the  update  algorithms  are 
extracted  from  Reference  (16),  Chapter  III.  The  update  algorithms 
are  approximations  to  integrals  of  Equations  2 “2  or  2 “3- 
Equation  2-2  is  integrated,  the  rotation  quaternion  must  be  con¬ 
verted  to  a  rotation  matrix  at  least  for  extraction  of  attitude 
angles,  an  operation  requiring  at  least  9  multiplications  and 
12  additions.  In  either  case  the  quaternion  (or  matrix)  must 
be  periodically  nontialized  (or  orthonormalized)  to  ensure  that 
a  rotation  is  truly  represented.  A  first  order  algorithm  is 
invariably  employed  for  this  purpose.  A  quaternion  normaliza¬ 
tion  requires  8  multiplications  and  4  or  5  additions,  while  a 
matrix  orthonormalization  requires  54  multiplications  and  42 
additions  plus,  in  either  case,  a  number  of  loads,  stores,  shifts, 
etc.  This  latter  operation  constitutes  one  of  the  chief  attrac¬ 
tions  of  the  quaternion  update. 


2. 3. 3. 2.1  Direction  Cosine  Updating 

For  the  case  of  the  rotation  (direction  cosine) ,  matrix 
update  of  order  i  =  1,  2,  3,  the  updated  matrix  is  C^(t  +  At) 
where 


and 


C^  (t  +  At)  =  C(t)  M^(t,At) 


Mj^(t,At)  =  I 


0 

-6 


-6, 

0 

9. 


(2-8) 


(2-9) 


and  M2(t,At)  =  M^(t,At).+  ^ 
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In  the  foregoing,  0.,  where  D  =  x,  y,  z,  was  used  instead  of  the 

b  ^  b 

components  of  simply  for  economy  of  notation. 

6j  is  0j  from  the  previous  high  speed  computation  cycle. 

* 

2  2  2  2  ■ 

X  y  z 

It  is  noted  from  Equations  2-9  and  2-11  that  the  off-diagonal 
elements  of  the  first  and  third  order  update  matrix  form  a  skew 
symmetric  matrix;  hence,  there  are  only  three  distinct  elements 
to  compute.  The  second  order  update  matrix  is  symmetric  and 
involves  six  distinct  elements.  Thus  a  subroutine  may  easily 
be  constructed  to  perform  a  first,  second,  or  third  order  update 
depending  only  on  the  value  of  a  control  parameter,  IC,  where 
IC  =  IOU-2,  and  lOU  is  the  integer  order  of  the  update.  The  flow 
chart  of  directional  cosine  updating  is  shown  in  Figure  2-21  . 

The  computations  for  a  third  order  update  are  divided  into 
four  boxes  10,  20,  30,  and  40  in  the  flow  chart.  Figure  2-1.  For 
a  second  order  update  only  the  computations  in  boxes  10 ,  30  and 
40  are  performed.  For  a  first  order  update  only  box  30  is 
required.  Following  the  indicated  operations ,  the  body-to-compu- 
tational  frame  rotation  matrix  is  updated  (and  periodically  ortho- 
normalized)  .  Then  the  Av's  are  transformed  and  summed  over  At  . 
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Figure  2-7.  Flow  Chart  for  1st,  2nd  or  3rd  Order  Direction 
Cosine  Update  Matrix 
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BOX  10 


FORM  SECOND  ORDER  TERMS  AND  SECOND  ORDER 

PORTION  OF  UPDATE 

DTXS  «=  (DTHX*DTHX)/2 

DTYS  <={DTHY*DTHY)/2 

DTZS  <=(DTHZ*DTHZ)/2 

DTXY  ■«=  (DTHX*DTHY)/2 

DTYZ<=lDTHY*DTHZ)/2 

DTZX  <=(DTHZ*DTHX)/2 


[DA2]  <= 


-DTYS-DTZS  DTXY  DTZX 
DTXY  -DTZS-DTXS  DTYZ 
DTZX  DTYZ  4>TXS  -DTYS 


BOX  20  -  FORM  THIRD  ORDER  TERMS  AND  ELEMENTS  OF  FIRST  PLUS 

THIRD  ORDER  UPDATE 
XDTX  -<=  (DTHZ«ODTY-DTHY*ODTZ)*(1/12) 

XDTY  <=  (DTHX*ODTZ-DTHZ*ODTX)*(1/12) 

XDTZ  ■«=  (DTHY*ODTX-DTHX*ODTY)»(1/12) 


Figure  2- 7a.  Updating  of  Body-to-Computation  Frame  Direction 
Cosines  Matrix 
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BOX  20  -  ODTX<=DTHX 

(CONTINUED)  ODTY  <=DTHY 

ODTZ^DTHZ 

SCL1  <=1.  -  (DTXS+DTYS+DTZS)*(1/3) 

DTHX  «=SCL1*DTHX+DTX 
DTHY  <=SCL1*DTHY+XDTY 
HTHZ  ^SCL1*DTHZ+XDTZ 


BOX  30  -  FORM  FIRST  PLUS  THIRD  ORDER  PORTION  OF  UPDATE 

[R5.5N]  ^  fl-  -DTHZ  DTHY" 

DTHZ  1.  -DTHX 

-DTHY  DTHX  1. 

-  ^ 


BOX  40  -  ADD  FIRST  PLUS  THIRD  ORDER  PORTION  TO  SECOND  ORDER 

PORTION 

[R5.5N]  <=  [R5.5N]  +  [DA2] 


Figure  2-7b.  Direction  Cosine  Matrix  Updating  (Continued) 
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2. 3. 3, 2. 2 


The  steps  involved  in  generating  an  updated  rotation  matrix 
relating  the  computational  frame  to  the  body  frame,  given  the 
— cb'  presented  using  quaternions.  As  before  first, 

second,  and  third  order  updates  are  considered.  In  the  present 
case  the  updated  quaternion  is  q^^^ (t+At)  where 


qi^^  (t+At)  =  q(t)  P 


and 

p-^^'  (At) 

and 

(At) 

and 

P^^>  (At) 

(2-12) 

(2-13) 

(2-14) 

(2-15) 


The  operation  indicated  in  Equation  C-12  is  multiplication  of  two • 
quaternions  where: 

f  4  Pg  +  £ 

and  p  =  ^2^ 

/V  ^ 

and  i,  k  are  the  frame  vectors  (unit  magnitude,  mutually 
orthogonal,  right  handed)  (in  the  particular  case  i,  j,  k  are 
along  the  x,  y,  z  axes  of  the  body  frame) . 

A  good  concise  summary  of  the  elements  of  quaternion  algebra  is 
presented  in  Section  2.2.1  of  Reference  16 .  The  product  of  two 
quaternions,  p  and  q,  may  be  written  as 

qp  =  qgPo  ~  3*E  +  3Po  ^ 
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The  preceding  vector-^scalar  form  may  be  handy  analytically  but 
the  most  efficient  form  for  mechanization  in  a  digital  computer 
is  as  the  product  of  a  4  x  4  matrix  by  a  4  x  1  vector,  i.e.. 


qp  = 

~Pq  “Pi  -P2  “P3~ 

Pi  Pq  P3  "P2 

P2  “P3  Pq  Pi 

^2 

_P3  P2  -Pi  Po_ 

L-  _ 

(2-16) 


The  purist  may  object  that  Equation  2-16  is  an  expression  for 
the  elements  of  the  quaternion  product  ^rather  than  the  product 
per  se  which,  of  course, ‘is  correct*  To  be  rigorous  then  the  left 
hand  side  of  Equation  2“-16  should  be  expressed  as 

r(qp)o  (qp)2 


The  rearranged  product  pg  is  given  below; 

pq  =  Po<3o  "  E  *  a  +  Poa  +  e^q  +  E^a 


(2-17) 


(pg)o 

= 

Pq  “Pi  “P2  “P3 

■ao 

(pg)  1 

Pi  Pq  “P3  P2 

ai 

(pg)2 

P2  P3  Pq  “Pi 

a2 

/pa)  3 

U) 

1 

to 

H 

1° 

a3 

The  first  and  third  order  updates  affect  the  elements  p^^,  p^ ,  and 
p^,  while  the  second  order  update  portion  affects  only  the  element 
Pq.  All  orders  of  quaternion  updates  work  with  half  the  angle 
rotation,  hence  the  first  operation  is  to  divide  the  elements  of 
the  corrected  A 8^  by  two  (right  shift)  and  work  thereafter  with 
Ae^/2. 
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are 


For  the  first  order,  update,  the  quaternion  elements, 


(1) 


P 


(1) 


0 
(] 

L 
(1) 


=  0,/2 


=  Op/2 

pf  ^  =  63/2 


(2-18) 


(2) 

For  the  second  oruer  update,  '  becomes 


=  1  -  A  (£  •  i|=  1  -  1  ( I 


=  1  - 


'0., 


^  y 


2  -1 
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For  the  third  order  update,  p|^^ /  P^^^ »  '  become 


p'=' 


1  £.^01  ^  1  /  e*  0'^ 

6  ^2  '  2  y  2  6  \^f  ^  ^2  y 


,(3)  - 


„(3)  _ 

P3  - 


1  _  i(i 
6  V2 


-1(1/ 


.  i(  0 
6  V  2 


^  ,  1  ®2  ®2  ^ 

2  6V2  2  "  2  2 
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®3  1  /®1^3  ®1  ®2 

T  6  VT  "2"  ■  T  T 
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Note  that  the  subscripts  2,  3  are  equivalent  to  subscripts 
X/  Y/  z,  used  in  the  direction  cosine  update. 


A  similar  logical  flow  may  be  employed  for  the  elements  of 
the  update  quaternion  as  was  used  in  the  direction  cosine  update. 
The  initial  step,  as  noted  previously,  is  division  of  the  A 9^ 
by  two.  Following  generation  of  the  ,  the  4x4  matrix  is 

formed  and  the  quaternion  multiplication  is  perforaed  (4x4)  x 
(4  X  1)  with  subsequent  normalization  (perhaps  at  lower  frequency) 
and  conversion  of  the  updated  quaternion  to  a  direction  cosine 
matrix. 
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The  ensuing  Av  transformation  and  summation  and  attitude 

extraction  are,  of  course,  independent  of  the  method  used  to  con 

struct  the  direction  cosine  matrix.  • 

The  flow  chart  shown  in  Figure  2-8  presents  the  computa- 
*  cl 

tions  starting  with  ^  and  ending  with  the  updated  Cj^  (or  Cj^) , 

The  details  of  computations  are  shown  in  Figures  2-8a,  b  and  c. 
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Figure  2-8.  Flow  Chart  for  1st,  2nd,  and  3rd  Order  Quaternion 

. Update 
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BOX  100 


-  SCALE  A0j's  AND  SET  pq  =  1 
DTHX<=DTHX/2 
DTHY«=DTHY/2 
DTHZ«=DTHZ/2 

P0<=1. 


BOX  110  —  FORM  AND  po  FOR  SECOND  ORDER 

TS02  ■*=  {DTHX*DTHX+DTHY*DTHY+DTHZ*DTHZ)/2 
P0'«=1.-TS02 


BOX  120 


FORM  3RD  ORDER  TERMS,  SAVE  Adj's. 
XDTX  <=  (DTHZ*ODTY-DTHY*ODTZ)*  (1/6) 
XDTY  «=  (DTHX*ODTZ-DTHZ*ODTX)»(1/6) 
XDTZ  <=  (DTHY*ODTX-DTHX*ODTY)»{1/6) 
CON-*=1.-TS02*(1/3) 


PI  <=CON*DTHX+XDTX 
P2  <*=CON*DTHY  +  DTY 
P3  ^CON’DTHZ  +  XDTZ 


Figure  2-8a.  Updating  of  Body-to-Computational  Frame,  Direction 

Cosine  Matrix,  Using  Quaternion  Transformation 
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BOX  120  -  ODTX<=DTHX 

ODTY-<=DTHY 
ODTZ-«=DTHZ 


BOX  130  -  FORM  1ST  OR  2ND  ORDER  P^,P2,P3 

P1'«=DTHX 
P2-«=DTHY 
P3-«=DTHZ 


BOX  140 


FORM  update  matrix  AND  MULTIPLY 
[UPDO]  ^  r  PO  -PI  .P2  -PB 
PI  PO  P3  -P2 
P2  -P3  PO  PI 
P3  P2  -PI  PO 


<=[UPDQ}* 


Figure  2-8b.  Computation  for  Updated  D.C.M.  (continued) 


2-32 


BOX  150 


NORMALIZE  UPDATED  QUATERNION 

COR  «=1.  -  (00*00+01  •Q1+Q2*Q2+Q3*Q3-1.)/2 


BOX  160  -  CONVERT  QUATERNION  INTO  DC  MATRIX  (Cij) 

Q1S  <=01*01 
028'^  02*02 
038  <=03*03 
Q01  <=00*01 
002  <=00*02 
003  <=00*03 
012  <=01*02 
023  <=02*03 
031  <=03*01 

C11<=1.-2*(Q2S+Q38) 

C12<=2*(Q12-Q03) 

C13<=2*(Q31+Q02) 

C21  <=2*(Q12+Q03) 

C22<=1. -2*(Q3S+Q1S) 

C23<=2*(Q23-Q01) 

C31  <=2*(Q31-Q02) 

C32<=2*(Q23+Q01) 

C33<=1.-2*(Q18+Q28) 


Figure  2-8c.  Computation  for  Updated  D.C.M.  (continued) 
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2. 3. 3. 3  Av  Transformation  for  SDIMU 

For  the  SD  systems  considered  both  the  incremental  angles, 
b  .  h 

r  the  incremental  velocities,  Av.  are  accumulated  over 

xjj  - — i 

the  same  interval,  At^^.  This  is  compatible  with  the  output  format 

of  the  profile  generator  program.  Some  SD  systems  alternate  the 
b  b  * 

outputs  of  and  ^  at  intervals  of  At^y2*  While  the  updated 

is  appropriate  for  attitude  computations,  it  is  one  half  a 
high  speed  computation  cycle  (At  /)  ahead  of  the  transformation 

.  b  ?  n 

required  for  the  ^  .  An  interpolated  value  for  is  required 
b  ^ 

for  Av  transformation.  When  a  direction  matrix  update  is  used, 

it  would  feasible  to  en5)loy  techniques  analogous  to  those  des¬ 
cribed  in  section  2.4.4  for  extrapolating  the  direction  cosine 
matrix  in  the  navigation  algorithm.  However,  when  a  quaternion 
update  is  used,  there  is  nothing  corresponding  to  the  "update" 
which  is  added  to  the  "old”  direction  cosine  matrix  to 
obtain  the  "new"  direction  cosine  matrix  (dcm) . 

The  simple  expedient  employed  in  both  cases  was  siir5)ly  to 
store  the  "old"  dcm,  ,  before  generating  the  "new"  dcm,  , 

N-1  N 

and  then  after  the  update  use  the  average  matrix  as  C° 

b  N-1/2 

for  the  ^  transformation. 

i.e. , 


(2-21) 


While  the  above  equation  produces  errors  which  are  second  order 
in  (see  Appendix  E) ,  they  are  not  cumulative  in  their  effect 

on  . 

Finally,  the  transformed  Av^  is  given  by 


^N-l/2  “ 


(2-22) 


In  the  foregoing  all  the  subscripts,  N,  N-1/2,  N-1,  refer  to  the 
high  speed  strapdown  con5>utation  cycle. 
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2. 4  Navigation  Equations 


2.4.1  Navigation  Equations  in  Local  Vertical  Frame 

The  fundamental  equation  of  inertial  navigation  for  a 
navigator  employing  an  earth  relative  computational  frame 
(c-space)  is  given  by 


v°  =  f °  +  2°  -  (fi' 


ec 


(2-23) 


where  v 


V 


e 


i 


le 


is  the  earth  relative  velocity  in  the  computational 
frame 

is  the  time  rate  of  change  of  v° 

is  the  specific  force  (the  portion  of  inertial  accelera¬ 
tion  sensed  by  the  accelerometers)  expressed  in  compu¬ 
tational  frame  coordinates 

A  G*^— r*^,  is  the  resultant  of  mass  attraction, 

—  —  16  16 

and  centripetal  force,  /  expressed  in 

computational  frame  coordinates 

is  the  earth  fixed  frame  which  is  rotating  at  a  constant 
angular  rate,  with  respect  to  the  inertial  frame 

is  the  earth -centered  inertial  frame  which  is  regarded 
as  non  rotating  with  respect  to  the  "fixed"  stars 
is  the  skew-symmetric  form  of  the  angular  velocity 
of  the  computational  frame  with  respect  to  the  earth 

fixed  frame,  expressed  in  computational  frame  coordinates, 
c 

— ec 

is  the  skew-symmetric  form  of  the  angular  velocity  of 
the  earth-fixed  frame  with  respect  to  the  inertial 

c 

frame,  expressed  in  computational  frame  coordinates, 

The  magnitude  of  is  a  constant  but  the  com¬ 

ponents  vary  as  a  function  of  latitude  (and  wander 
angle) . 


The  function  of  the  navigation  computer  may  be  considered 
to  be  the  integration  of  equation  (2-23) ,  to  obtain  the  earth 
relative  velocity,  v^,  followed  by  a  second  integration  to  obtain 
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the  earth  relative  position.  Since  the  earth  relative  position 

is  expressed  mainly  in  angular  coordinates,  latitude,  longituder 

(and  wander  angle), it  is  necessary  to  convert  the  level  components 

of  linear  velocity  from  the  first  integration  into  angular 

velocity  form  by  dividing  by  the  appropriate  variable  r-  radii  of 

c 

curvature  to  obtain  w  which  is  then  converted  to  the  skew  sym- 
c 

metric  form,  The  differential  equation  which  is  integrated 

ec 

to  obtain  the  angular  position  is 


C 


3 

C 


ec 


(2-24) 


The  actual  latitude,  longitude  (and  wander  angle)  are  extracted 
e 

from  via  the  appropriate  inverse  trigonometric  functions. 

The  remaining  position  variable,  altitude  is  obtained  by 
integrating  the  vertical  component  of  .  An  external  altitude 
reference  is  required  to  eliminate  the  inherent  instability  of  any 
pure  inertial  vertical  channel.  Thus,  the  minimum  number  of 
scalar  integrations  required  to  mechanize  a  local  vertical  wander 
azimuth  navigator  is  thirteen  (13) .  However,  only  five  of  the 
nine  (9)  elements  of  are  employed  directly  in  the  navigation 
computations  so  frequently  only  six  of  the  nine  elements  are 
computed . 
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2. 4. 1.1  Methods  of  Presentation 


There  are  a  number  of  ways  of  presenting  the  equations  which 

are  to  be  mechanized  in  a  navigation  computer. 

(a)  The  highest  level  presents  the  exact  differential  equations 
(and  other  equations  or  functions  for  angular  velocity, 
gravity,  etc.).  At  this  level,  there  is  no  order  to  the 
equations  since  all  the  values  of  the  variables  and  their 
derivatives  are  instantaneous.  The  same  information  may  be 
expressed  in  state  space  (matrix— vector)  form  or  in  analog 
block  diagram  form. 

(b)  A  second  level  is  the  difference  equation  form,  which  is 
probably  the  most  informative  quasi-^nalytical  method.  Here, 
too,  the  order  in  which  the  equations  appear  is  irrelevant 
since  all  the  variables  are  tagged  with  the  (discrete)  times 
when  they  were  computed.  From  the  difference  equations, 
detailed  computational  flow  diagrams  may  be  constructed  which 
convey  the  same  information  in  a  more  graphic  form.  This 
latter  form  implies  a  particular  sequence  or  order  to  the 
computations. 

(c)  A  third  level  is  the  functional  flow  chart  which  generally 
contains  a  verbal  description  of  an  unalterable  sequence  of 
arithmetic  operations  on  a  number  of  variables  and  constants 
within  a  single  "box".  Logic  and/or  decisions  maybe  incor¬ 
porated  via  standard  flowchart  symbols.  The  order  of  the 
computations  appears  explicitly.  The  individual  "boxes" 
may  be  inline  coding,  subroutines  or  functions. 

(d)  A  fourth  level  is  the  detailed  flowchart  which  may  be  manually 
drawn  or  from  AUTOFLOW  or  similar  program. 

(e)  A  fifth  level  is  the  program  listing  in  a  higher  order 
language  (FORTRAN  in  this  case) .  The  usefulness  of  the 
listing  is  strongly  dependent  on  the  definition  of  the  mnemonics 
and  the  information  provided  by  the  comments. 

(f)  The  sixth  (or  lowest)  level  is  the  assembly  language  listing. 

In  the  present  study  this  is  of  immediate  interest  only  in 
the  case  of  the  precision  reduction  routine,  where  the 
routine  was  actually  written  in  assembly  language. 
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Generally,  presentation  at  the  third  or  lower  level  is 
incorporated  in  Volume  III;  the  first  and  second  levels  are 
included  in  this  volume.  Derivations  leading  to  the  first  or 

second  levels  are  relegated  to  Appendices  b,  Et,  and  E  of 
Volume  II. 
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2. 4. 1.2  Exact  Equations 


The  equations  to  be  integrated  and  the  intervening  computa¬ 
tions,  in  exact  form,  are  presented  below  for  the  undamped 
vertical  case. 

(1)  Derivative  of  velocity 


c  ,  c  ,^c  ,  ^^c  v„C 

V  =  f  +  g  -(![2  +  2f2.  )v 

—  —  —  '  ec  le  — 


(2)  Level  Components  of  Angular  Velocity 


(2-25) 


V 


c  — 


(2-26) 


0  T 

where  v  =  {v  v„v,^}  are  the  components  of  the  earth  relative 
—  U  E  N 

velocities  in  the  local  vertical,  path  pointing  frame 


(LVN) . 

0 

=  X(a)  is  the  transformation  from  the  (LVWA)  computa¬ 
tional  frame  to  the  LVN  frame. 


where 


and 


-V 


r^(L)  +h 
m 


N 


E 

"n  r  (L)  +  h 

P 


r^(l-e-) 


(1-e^  sin^L) 


1/2 


/I  2  .2^. 

(1-e  sin  L) 


T72 


(2-27) 

(2-28) 

(2-29) 

(2-30) 


r^(L),  ^p(E)  are  the  meridian  and  prime  vertical  radii  of 
curvature  on  the  surface  of  the  ellipsoid  at  geodetic 
latitude,  L  =  Lg,  defined  in  Appendix  C. 

r^  =  a,  is  the  sealevel  equatorial  radius  of  the  earth  (or 
the  semi  major  axis  of  the  meridional  ellipse) . 

€  =l 1-  — yJ  is  the  eccentricity  of  the  meridional  ellipse 
whire  b  is  the  polar  radius  (or  semi-minor  axis) . 

(A)g,a)j^  are  the  level  components  of  the  angular  velocity  of  the 
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vehicle  with  respect  to  the  earth  in  the  LVN  frame,  w 


p  =  {0  0)^  0)^} 


(2-31) 


n  A  C 

where  £ =  is  the  angular  velocity  of  the  computation  frame 
with  respect  to  the  earth  fixed  frame  in  the  computational 
frame . 

(3)  Derivative  of  Direction  Cosine  Matrix 


c®  =  c® 

c  c  ec 


(2-32) 


where 


0  -P. 


(2-33) 


(4)  Earth's  Rate  and  Gyro  Torquing 


c  c  c  c 

W.  =(0  +0).  =  p+O). 

—1C  — ec  — 1  e  —  — 1  e 


(2-34) 


where  to?  =  to?  =  {0  0  to. 

—le  — le  le 

T 

and  (oT  =  (C^)  to? 

— le  '  c  — le 


(2-35) 


(2-36) 


(5)  Cotriolis  and  Centripetal  Acceleration 


(“Jc  2  (£ie)  X  v°  =  ((0.^  +  0).^)  X  / 


(2-37) 


where  and  are  the  skew- symmetric  forms  of  w?  ,  the 

ic  le  —1C 

gyro  torquing  signals,  and  the  earth  rate  in  the 

computational  frame. 
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(6)  Gravity  Computation 


where 


Z 


g 


■-(g^  +  ^2  ■'■  ^4  sin  L)  [1  -  sin  Dh+gj^^h  ] 

0 

-  g„h  sinL  cosL 

N  (2-39) 


and 


gQ,  92  >  H  constants  in  the 

gravity  equation 
h  is  the  altitude 

sinL,  cosL  are  the  sine  and  cosine  of  the  geodetic  latitude 


(7)  Derivative  of  altitude 


h  =  V 


.c 


(2-40) 


(8)  Position  extraction  and  LVN  Velocities 

(■=0)31 


L  =  tan 


-1 


X  =  tan 


-1 


(^0)21 


2-T^/r 


K)iij 


+  X, 


a  =  tan 


-1 


(=c) 


32 


(^0)33, 


(2-41) 


(2-42) 


(2-43) 


v° 

—  C  ~ 


(2-44) 


where  =  X(a) 


10  0 
0  cosa  sina 
0  -sina  cosa 


(2-45) 


and  a  is  the  present  wander  angle  (positive  east  of  north) 
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X,  X^  are  the  present  and  initial  longitude  (positive  east 
of  Greenwich  meridian) 

L  is  the  geodetic  latitude  (positive  north  of  the  equator) 

£ 

V  =  velocity 
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2.4.2  Vertical  Channel  Damping 


The  inherent  instability  of  the  vertical  channel  of  any 
pure  inertial  navigator  is  due  to  errors  in  the  computation  of 
2°  resulting  from  errors  in  the  computed  altitude  or  due  to 
vertical  accelerometer  errors.  Linearizing  the  expression  for 
the  vertical  component  of  gravity  in  the  previous  section  we 
have 


where 


1 


2 


r 


o 


or 


-go 


+ 


h 


(2-46) 


(2-47) 


The  second  term  on  the  right  is  the  potential  positive  feedback 
term  and  will  result  in  an  exponentially  diverging  altitude 
error  for  the  most  infinitesimal  initial  error.  A  block  diagram 
of  the  undamped  vertical  channel  is  show  in  Figure  2-9. 


Figure  2-9.  Undamped  Vertical  Channel  Block  Diagram 

A  non-inertial,  external  altitude  reference,  h^  (generally 
a  barometric  altimeter)  is  incorporated  into  the  vertical  channel 
via  conditional  feedback  loops  as  illustrated  in  Figure  2-10 
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The  characteristic  equation  for  loop  shown  in  Figure  2-10. 

2g 

‘o 


+  C 


1  "  f  ^  -  ?) 


s  +  =  0 


(2-48) 


which  represents  a  stable  damped,  third  order  system  for  all  of 
C. ,  Co  positive  and 


25c 


(2-49) 


If  =  0,  the  system  reduces  to  second  order.  Both  cases,  with 
a  range  of  values  for  the  parameters,  occur  in  practice. 

The  additional  (differential)  equations  which  are  required 
for  third  order  damping  implementation  are: 


=  fx  +  5^  -  [(^°,  +  -sah 


-  6a 


2)  h  =  V  -  C,  6h 
X  1 


(2-50) 


3)  6a  =  C3  6h 


4)  6h  =  h  -h 


B 


Typed  underlining  indicates  the  additions. 
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2.4.3  "Baseline"  LVWA  Navigation  Algorithm  (in  Difference 
Equation  Form 

The  equations  mechanized  in  the  "baseline"  LVWA  Navigation 
Algorithm  are  ordered  as  shown  in  Table  2~1.  Each  number  represents 
a  fixed  sequence  of  operations  applicable  at  all  levels. 


Table  2-1 


Local  Vertical  Wander  Azimuth  Navigation  Algorithm  with  Vertical 

Damping 

1  Update  computational  frame  velocities,  (store  old  velocities)^^^^^^^^^ 

2  Add  vertical  damping  terms. 

3  Compute  angular  velocities  about  level  axes. 

INRNAV  or  ANGVL2 

4  Update  direction  cosine  matrix  (1st  or  2nd  order) .  DCMUPD 

5  Orthonormal ize  direction  cosine  matrix  (1st 

order) .  ORTHO 

6  Compute  earth's  rate  signals 

*7  Compute  gyro  torquing  signals. 

TORCOR 

8  Compute  angular  velocity  [for  ( wxy)  ] • 

9  Compute  ( wxv) At  terms  (for  velocity  update)  j 

10  Compute  altitude  and  vertical  damping. 

INRNAV 

11  Compute  gravity  components.  GRAV 

*12  Extract  position  and  wander  angle. 

1  POSVEL 

*13  Form  wander  angle  matrix  and  LVN  velocities. 

( 

*Shown  as  separate  blocks  in  computational  flow  diagrams. 


General 

Second  level  consists  of  presenting  the  approximate  integrals 
of  the  differential  equations  and  approximation  to  the  other 
functions  in  difference  equation  form,  generally  using  a  rectangular 
integration  scheme. 
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Generally,  one  (or  more)  fixed  navigation  computation  cycle (s) 
is  (are)  employed.  Consider  just  one  computation  cycle  for  naviga¬ 
tion,  At,  where  At  is  a  binary  fraction  of  a  second  for  minimiza¬ 
tion  of  the  computational  load  and  truncation.  Time  in  navigation 
is  set  to  zero  (t=0)  at  the  moment  of  entry  into  navigation  i.e., 
at  the  conclusion  of  initialization;  thereafter  elasped  time  is  up¬ 
dated  by  counting  the  number  of  navigation  computation  cycles  which 
have  elasped  since  initialization.  Time  at  end  of  the  n —  naviga¬ 
tion  computation  cycle  is  denoted  by  t^  where  t^^  =  nAt. 

The  function  of  the  navigation  algorithm  is  to  update  the 
navigation  parameters  to  t^  from  their  values  at  based  on  the 

incremental  velocity  and  other  data  available  at  t^.  In  the  case  of 
a  local  vertical  system,  the  navigation  computations  at  tn  must 
also  provide  gyro  torquing  signals  to  be  applied  from  t^  to 

NOTE:  In  passing  to  the  difference  equation  form,  the  literal  super¬ 

scripts  and  subscripts  designating  coordinate  frames  are  replaced 
by  their  numerical  equivalents  to  correspond  more  closely  with  program 
mnemonics.  The  following  table  will  clarify  the  designations: 


Frame  Name 

Designation 

Literal 

Numerical 

Inertial 

i 

0 

Earth-fixed 

e 

O' 

Local  vertical,  north 
pointing 

Z 

2 

Local  vertical,  wander 
azimuth  or  computational 

c 

2’ 
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1.  Update  Computational  Frame  Velocities 

Defining  the  corrected  incremental  velocity  output  of  the  X 
accelerometer  of  a  local  vertical  IMU  at  tj^  as 


/,  nAt 
(n-1)  At 


(2-51) 


where  is  the  quantization  of  the  x-accelerometer  and  -l<e^<l, 

the  velocity  update  equation  for  the  simplest  algorithm  will  be  written 

as 


? '  2 '  2 ' 

v;(u)  =  v^(d)  +  Av^ 
-n  -n_i  — n 


(2-52) 


where 

2* 

V  (u)is  the  velocity  vector  in  the  2'  frame  at  time  t  un- 
--n  n 

damped  i.e.  without  the  addition  of  the  vertical  damping 
correction. 

2  ’ 

V  (d)  is  the  damped  velocity  vector  in  the  2'  frame  at  time  t  , 

T  n” J- 

n-1 


Q 


2' 

O' 


,2' 


n-1 


2 

0,0* 


n-1 


is  the  vector,  one  component  of  which  is  given  by  Eqn  (2-51). 

is  the  gravity  vector  in  the  2'  frame  computed  at  time 
t^_j^  (or  (n-1) At). 

is  the  skew  symmetric  form  of  the  angular  velocity  of  the 

2'  frame  with  respect  to  the  O' -frame  expressed  in  the  2' 

2 ' 

frame  and  computed  at  time  t  w  t  o  i 

n-J-  u 

is  the  skew  symmetric  form  of  the  angular  velocity  of  the  0* 
frame  with  respect  to  the  0-frame  expressed  in  the  2*  frame 
and  computed  at  time 


At  is  the  navigation  computational  cycle. 
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2.  Add  Vertical  Damping  Terms 


Vertical  damping  terms  are  added  for  one  component  of  velocity 

viz: 


n  n 


(2-53) 


where  the  subscript  x  refers  to  the  first  or  vertical  component  of 
velocity  in  the  2'  frame 
C2  is  a  constant 


«Vl4hB 


-h 


n-1 


n-1 


h_  is  the  reference  (barometric)  altitude  at  t  , 

Vl 

hn_i  is  the  system  computed  altitude  at 

6a^_j^  is  defined  by  Eqn.  (2-67)  with  n  replaced  by  n-1 


3 .  Compute  Angular  Velocities  About  Level  Axes 


The  level  components  of  the  angular  velocity  due  to  vehicle 

2  ’ 

motion  over  the  earth,  2?  or  £  computed  using  the  approximate 
equation  are: 
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NOTE: 


4o 


O', 2’, 


where  is  a  constant  equal  to  the  equatorial  sea  level  radius 

of  the  earth,  a,  i.e.,  the  semi-major  axis  of  the  meridional 
ellipse;  e  is  a  constant  equal  to  the  ellipticity  of  the 

meridional  ellipse,  - ,  i.e.  the  difference  between  the 

semi-major  and  semi-minor  axes  of  the  meridional  ellipse 
divided  by  the  semi -major  axis;  is  the  system  com¬ 

puted  altitude  at  time 


is  the  second  element  of  the  third  row  of  the  LVWA  to  earth 

0  * 

fixed  transformation,  ^2*'  time  equal  to 

-cosL  T  sina_  , . 


j  is  the  third  element  of  the  third  row  of  the  LVWA  to  earth 

^  fixed  transformation,  at  time  It  is  equal  to 

cosL  T  cosa  T . 
n-1  n-1 

2  ’  .  th 

0).  where  i=x,y,z,  is  the  i  component  of  the  angular  velocity 

■*“0*  2' 

'  n  of  the  (LVWA)  computational  (2*)  frame  with  respect  to 
the  earth  fixed  (O')  frame  expressed  in  the  2'  frame- 
computed  at  time  t^_^. 

NOTE:  (a)  Due  to  the  similarity  in  the  expressions  for  the  y  and  z 

2 ' 

components  of  ,  many  computational  simplifications 

n 

can  be  realized  in  the  actual  mechanization  of  these  ex¬ 
pressions. 

(b)  For  compactness  of  notation  the  elements  of  are 

'  n 

frequently  expressed  as  where  i=x,y,2. 


i 

O'  ,2' 
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4.  Update  Direction  Cosine  Matrix 


The  direction  cosine  matrix,  C,,  ,  is  updated  (to  the  first 


n-1 


order)  using  the  computed  above  viz: 


n 


O'  O'  O'  7 ' 

C,,  =  C,,  +  C"  At 

n-1  ^  n-1  n 


(2-55) 


n 


2  * 

where  ^o',2'  skew  symmetric  form  of  Wq,  £„) • 

5.  Orthonormalize  Direction  Cosine  Matrix 

Periodically,  the  direction  cosine  matrix,  C®,  ,  may  be  ortho- 


normalized  (to  the  first  order)  vizi 


Cj,  (ortho)  =  C®,  “  7  ^2 


n 


n 


(2-56) 


where  C_,  (ortho)  is  the  result  of  performing  the  indicated  opera- 

^  n  .  O'  O' 

trons  on  C2,  •  The  former,  C2,  (ortho),  is  restored 

^  .  O' 

in  the  same  locations  as  C„,  ,  and  the  same  designation, 

0  *  ^  n 

C^,  f  is  used 

n 

6 .  Compute  Earth’s  Rate  Signals 

The  angular  velocity  of  the  earth  fixed  (O')  frame  expressed  in 
the  computational  (2')  frame  is  computed, 

T 

{sinL^,  -“CosL  sina_,  cosL  cosa  }  w.  (2-57) 
n  n  n  n  n  le 
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O'  /,0'  0 

where  =  Cq^ 


since  Cq  = 

n  ^ 


and  ={0  0  ^ 


where  w®  q,  =  (^o'o'  “ie  constant  magnitude  of  angular  velocity 

of  the  earth  in  the  inertial  frame,  is  entirely  along 

the  z  axis  of  the  inertial  or  earth  fixed  frames. 

7.  -  Compute  Gyro  Torguing  Signals 

2  * 

Gyro  torquing  signals^  21  computed  viz: 


^'2'n  ' 


(2-58) 


where  ^2^  total  angular  velocity  of  the  LVWA  gyros  with 

inertial  frame  required  to  maintain  the  LVWA  platform  in  the 
desired  orientation  (no  gyro  drift) . 

NOTE:  (a)  the  values  shown  in  (2-58)  those  rates  which  will 

be  applied  continuously  from  t^^  to  If  the  angle 

to  be  torqued  is  required  both  sides  of  the  equation  are 
multiplied  by  At. 


8.  Compute  Angular  Velocity  (for  wxv) 

The  angular  velocity  for  the  Coriolis  and  centripetal  terms 
is  computed  viz: 


2  •  2 '  2  *  2  ’ 

(jl)  ^  i  ■+■  2(A)  —  (A)^^.  “I"(a)«.^.A  (a) 

-0 ' , 2 ' ^  -0 , 0 '  -0,2'  -0,0'=  -n 

n  '  n  '  n  n 


(2-59) 


where  is  introduced  for  compactness  of  notation. 

NOTE:  For  the  velocity  update  function,  is  multipled  by  At, 
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9.  Compute  (wxv)At  (for  velocity  update) 


The  Coriolis  and  centripetal  portion  of  the  velocity  update 
is  computed  viz : 


(2-60) 


2'  2 ' 

where  qi  is  the  skew  symmetric  form  of  Wq  q, 


and  all  other  terms  have  been  defined  earlier. 


Compute  Altitude  and  Vertical  Damping 

The  altitude  and  vertical  damping  terms  are  computed  viz; 


h  =  h  .  +  (v^  t  C-  6h  n ) At 
n  n-1  \  ^n-1  ^  n-1/ 


^ 

n 


(2-61) 


6a  =  6a  .  +  C,  6h  At 
n  n- 1  o  n 


where  h  is  the  system  computed  altitude  at  time  t 

n 

Cj^  is  a  vertical  damping  constant  (sec“^) 

hp  is  the  (barometric)  reference  altitude  at  t 
®n  n 

the  difference  between  the  barometric  and  system 

computed  altitudes  at  time  t  - 

n 

C^  is  a  vertical  damping  constant  (sec~^)  (C^  may  be  equal 

to  zero) . 

6an  is  C^  times  the  approximate  integral  of  the  computed 
altitude  difference  from  t=0  to  t=t  . 
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11.  Compute  Gravity  Components 


The  components  of  gravity  in  the  computational  frame 
are  computed  viz: 


where  gf  for  i=x,y,z,  are  the  components  of  gravity  in  the  computa- 
^n 

tional  ( 2 ' )  frame  computed  at  t^ 


and  c  f  C„  ,  C„  are 


constants  in  the  gravity  equations  with 


^  ^  units  of  (feet/sec) 

C  ,  C  are  constants  in  the  gravity  equations  with  units  of 
^  ^  (feet 


IS  a 


constant  in  the  gravity  equations  with  unit  of 


(feet~^) 


constant  in  the  gravity  equations  with  units  of 
(sec 

where  j  =  1,  2,  3,  are  the  elements  of  the  third 

0 " 

row  of  matrix  €2^  time  t^ 


2-53 


NOTE:  (a)  Before  being  applied  as  corrections  in  the  velocity 

equation  (2-52)  the  g?  are  multiplied  by  At 

^n 

(b)  •For  compatibility  with  the  accuracy  of  the  remainder 

of  the  "baseline"  algorithm,  the  constants,  , 

^h  r  Ch  ,  should  be  set  to  zero.  This  would  provide 
2  4 

a  gravity  model  of  slightly  greater  accuracy  than 
those  employed  by  most  of  the  systems  surveyed. 

•  The  form  and  constants  employed  in  Equation  (2-62)  are 
those  of  the  WGS72  Ellipsoidal  Earth  Gravity  Model 
(same  as  "upgraded"  algorithm) . 

•  The  value  of  these  parameters  are  not  under  operator  control. 

•  Effects  of  gravity  model  variations  on  navigation  and 
attitude  accuracy  are  not  among  the  parameters  to  be 
included  in  this  study. 


12.  Extract  Position  and  Wander  Angle 


Position  and  wander  angle  are  extracted  from  the  direction 

^  .  „0'  . 
cosine  matrix,  C„,  ,  viz: 

n 


(2-63) 


(2-64) 


(2-65) 
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where  L  is  the  geodetic  latitude  (positive  north  of  equator)  at  time 

\  is  the  geodetic  longitude  (positive  east  of  Greenwich) 
at  time  t^. 

Xq  is  the  geodetic  longtiude  at  t-0 

is  the  wander  angle  (positive  to  the  east  of  north)  at  t^^ 

NOTE:  If  (c2'in)ll  (^2'n)21  system  is 

exactly  at  the  north  or  south  pole  and  both  and  are 
indeterminate  therefore  the  previous  values  will  be  out¬ 
put  as  long  as  these  conditions  persist. 

13 .  Form  Wander  Angle  Matrix  and  LVN  Velocities 

Sine  and  cosine  of  wander  angle  are  used  to  transform  velocity 
from  computational  (2')  frame  to  local  vertical  north  pointing  (LVN 
or  2)  frame  viz: 

^  p2  ^2'  (2-66) 

-*n  2*n  ^n 

0  0  “ 

cosa  sina 
n  n 

sina_  cosa_ - 
n  n 

2  .  . 
and  V  is  the  earth  relative  velocity  in  the  LVN  frame  at  t  . 

^n  ii 


,2 

'2' 


where  C^,  =  X(a„)  = 


n 


n 


1 

0 

Lo 
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2. 4. 3.1  Upgrading  Baseline  Navigation  Algorithm 


2. 4. 3. 1.1  Introduction 

The  "baseline"  navigation  algorithm  presented  in  the  previous 
section  may  be  considered  as  representative  of  modetate  accuracy, 
local  vertical,  inertial  navigators  developed  in  the  mid-to-latter 
1960's. 

The  Inertial  Measurement  Unit  (IMU)  generally  interfaced  with 
a  dedicated  navigation  computer,  which  was  normally  a  small,  fixed 
point,  general  purpose  machine,  typically  with  a  24-bit  data 
word.  Speed  was  moderate  and  operations  like  division  were  to 
be  avoided  if  at  all  possible,  while  subroutines  like  square  roots 
were  not  considered  for  the  high  speed  loops.  Navigation  computa¬ 
tion  cycles  were  on  the  order  of  2  to  20  Hz. 

Considerable  ingenuity  was  devoted  to  the  development  of 
"baseline"  algorithms  that  primarily  involved  the  arithmetic 
operations  of  addition  and  multiplication  plus  loads,  stores,  and 
shifts. 

Further  ingenuity  was  involved  in  optimum  scaling  of  the 
variables;  the  use  of  binary  computation  cycles  for  the  integra¬ 
tions  obviated  the  necessity  to  perform  multiplications  in  many 
cases  or  replaced  the  multiplication  by  a  shift. 

The  net  result  was  a  compact,  efficient,  assembly  language 
program,  optimized  -  insofar  as  the  constraints  of  time  and  money 
permitted  -  for  the  particular  computer,  IMU,  and  mission. 

The  local  vertical  wander  azimuth  navigation  algorithms  surveyed 
integrated  linear  acceleration  once  to  obtain  linear  velocity 
(three  components);  converted  linear  velocity  to  angular  velocity, 
and  integrated  the  latter  once  to  obtain  angular  position. 

First  order  algorithms  were  used  throughout.  In  integrating 
the  V  (  denotes  differentiation  with  respect  to  time)  equation, 
it  was  assumed  that  the  acceleration,  a,  was  constant  over  the 
navigation  computation  cycle.  At;  hence 
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t+At 

I  a(T)dT 
t 


=  a(t) 


At 


(2-67) 


This  implied  that  a(t) ,  a(t),  etc.  were  all  equal  to  zero. 
Similarly,  in  integrating  angular  velocity,  w,  it  was  assumed 
that  w  was  constant  over  the  navigation  computation  cycle.  At, 
and  further  that  |w|  =  is  sufficiently  small  that  the 

.  terms  are  negligible;  hence  the  direction  cosine  matrix,  C, 
containing  the  angular  position  variables  is  updated  by 


C(t  +  At)  =  C{t)  [I  +  At] 


(2-68) 


where  I  is  the  3x3  identity  matrix  and  is  the  3x3  skew  symmetric 
matrix  corresponding  to  w.  This  implied  that  w(t) ,  w(t) ,  etc. 
were  all  equal  to  zero.  Compatible  approximations  in  the  conversion 
of  linear  to  angular  velocity,  in  the  computation  of  gravity  (the 
resultant  of  mass  attraction  and  centripetal  force),  and  in  the 
trigonometric  (sine-cosine)  and  inverse  trigonometric  (arctangent) 
functions,  were  also  part  of  the  "baseline"  navigation  software. 

The  objective  of  the  algorithm  upgrade  operation  is  the  removal 
some  of  these  assumptions  or  approximations  on  an  as-needed  basis 
to  permit  the  airborne  navigation  computations  to  appi^oach  the 
accuracy  of  the  PROFGEN  outputs,  which  are  considered  to  be 
perfect. 


2 . 4 . 3 . 2  Approach 

The  "baseline"  navigation  equations  were  incorporated  into 
the  numerical  simulator  (NUMSIM)  and  a  number  of  short  simulations 
were  performed.  The  errors  in  position,  velocity  and  attitude  rela¬ 
tive  to  PROFGEN  output  were  examined  and  the  most  significant  were 
analyzed,  using  expanded  printouts  where  necessary.  When 
the  offending  routine  was  identified,  its  performance  was  analyzed 
and  a  more  precise  routine  was  devised,  coded  and  tested.  Then 
the  procedure  was  repeated  for  the  most  significant  remaining 
errors.  The  user  is  provided  the  options  of  "turning  on"  the 
upgraded  algorithms  by  setting  one  or  more  flags  to  non  zero  values. 
This  procedure  is  described  in  the  User's  Guide  in  Volume  III. 
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2.4.4  Improved  Accuracy  Navigation  Algorithm 

The  equations  mechanized  for  the  "ideal  simulator  LVWA 
Navigation  Algorithm  incorporate  all  the  "upgrades”  discussed  in 
the  previous  section.  In  the  main,  the  t^grades  cpnsist  of  a 
certain  amount  of  interpolation  and  extrapolation  of  the  naviga¬ 
tion  variables.  The  object  of  these  operations  is  to  correct 
the  "phasing"  of  the  scalars,  vector,  and  matrix  variables  so 
that  a  higher  order  integration  algorithm  is  effectively  mechan¬ 
ized  —  but  with  little  more  conputational  load  than  is  required 
for  the  simple  "baseline"  software. 

The  main  addition  to  the  algorithm  is  the  repetition  of 
the  angular  velocity  computations  —  for  the  first  pass,  the 
interpolated  velocities  are  used  to  generate  angular  velocities 
for  the  direction  cosine  matrix  update,  while  the  second  pass 
uses  the  extrapolated  velocities  to  generate  the  torquing  signals 
and  the  Coriolis  and  centripetal  corrections. 

The  routines  are  summarized  in  Table  2-3.  The  form  of  the 
difference  equations  used  in  the  routines  is  listed  as  follows: 


1.  Updated  Cong)Utational  Frame  Velocities 


Note:  The  variables  with  subscript  (n-1/2)  are  the  extrap¬ 
olated  values  computed  at  i.e.,  (n  -  1  +  1/2)  . 


2.  Add  Vertical  Damping  Terms 
2 


Md)  -  (u)  + 


Note:  The  (d)  and  (u)  are  not  employed  in  the  subsequent 
equations  since  only  v(d)  is  saved. 
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TABLE  2-3 


Routines  for 


Upgraded  LVWA  Navigation  Algorithm  with  Vertical  Damping 


Sequence 

No.* 

Function 

Comments 

1. 

Update  computational  frame  velocities 

- 

from  (n~l)  to  n, 
store  old  velocities 

2. 

Add  vertical  Damping  terms 

2a. 

Interpolate  and  extrapolate  velocities 

to  (n-1/2)  and 
(n+1/2) 

3. 

Compute  angular  velocities,  £,  about 
level  axes,  for  d.c.m.  update,  using 
interpolated-  updated  velocities  and 
extrapolated  a,  L,  h. 

(at  (n-1/2) 

4. 

Update  direction  cosine  matrix 

to  n,  using  £  from 

3  and  2nd  order 
algorithm 

4a. 

Extrapolate  direction  cosine  matrix 

to  (n+1/2) 

5. 

Orthonomalize  direction  cosine  matrix 

10. 

Compute  altitude  and  vertical  damping 

extrapolate  h,  6h, 
store  as  old  value 

11. 

Compute  gravity  components 

using  extrapolated 

L,  h 

12. 

Extract  position  and  wander  angle 

Store  old  a 

13. 

Form  wander  angle  matrix  and  LVN 
velocities 

extrapolate  wander 
angle  sin  -  cos 

3a. 

Compute  [angular  velocities  about  level 
axes 

extrapolated  to 
(n+1/2) ,  for  torquing 
and  (w  X  v)  using 
extrapolated  V,  a, 

L,  h 

6. 

7. 

Compute  earth’s  rate 

Compute  gyro  torquing 

using  extra¬ 
polated  d.c.m.. 

8. 

Compute  angular  velocity  for  (w  x  V) 

Z'  £ 

9 . 

Compute  (w  X  V)  At  for  velocity  update 

♦Sequence  numbers  correspond  to  those  used  in  the  "baseline"  algorithm 
(see  Table  2-1) .  Additional  or  repeated  steps  are  indicated  by  a  suf¬ 
fix  "a". 
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2a.  Interpolate  and  Extrapolate  Verocities  Ito  C)i-l/2)  and  (n+1/2)] 
2'  „  1  /  2'  .  2'  \ 


1  /  2'  2'  \ 
^n-1/2  ==  2  \^n  ^  ^n-lj 

2'  1  /o  2 '  2 '  \ 

n+1/2  =  2\3Xn  '  Z  n-1  j 


(2-71) 


3 .  Compute  Angular  Velocities  about  Level  Axes 

Transform  level  components  of  velocity  to  LVN  frame 


2  2'  2 
yn-1/2  yn-1/2  n-1/2  2;n-l/2 


sin  a 


■'n-1/2  ^n-1/2 


an-1/2  +  V 


''n-1/2 


n-1/2 


n-1/2 


(2-72) 


Compute  E  and  N  components  of  angular  velocity 

2 

-V 


^n-1/2 


'n-1/2  + 


L  V  ^  11-1/2) 


2  [172 
31  - 


2 

^ n-1/2 


n-1/2 


n-1/2  + 


'  n-1/2/ 


2  11/2 


(2-73) 


VL  ^  n-l/2/3lJ  ; 

Transform  angular  velocity  to  computational  frame 


n-1/2 

P„  =  oj  cos  a  ,  ,,  -  a)„  sin  a  ,  ,,  (2-74) 

yn-1/2  Vl/2  Vl/2 


'n-1/2 


Op  sin  a  ,  /,  +  w  cos  a  . 

Vl/2  ^-1/2 
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where 


2 

^n-1/2'  i  =  Y/  z,  are  the  east  and  north  components  of 


r  v«iLf 

"n-l/2  ^n-1/2 


velocity  at  time 

2 

are  the  y  and  z  components  of  u-»  , 

n-1/2 

i.e.,  the  level  components  of  the 

angular  rate  of  the  vehicle  with  respect 

to  the  earth  fixed  frame  in  the  LVN 

frame  at  t  , ,  the  mid-point  of  the 
n-i/2 

nth  computation  cycle. 


2 ' 

,  Pv  *z  are  the  x,  y,  and  z  components  of  , 

Vly,  yn-1/2  n-1/2  ' ^'^n- 


n-1/2 


i.e.,  the  components  of  the  angular 
rate  of  the  vehicle  with  respect  to 
the  earth-fixed  frame  expressed  in 
the  computational  frame  at 

(C®!  ^  is  the  square  of  the  first  element  of 

\  2  n-1/2  4i 

the  third  row  of  the  transformation 
from  the  computational  frame  to  the 
earth  fixed  frame  (the  direction  cosine 
matrix)  at  t^_i/2*  equal  to 

®^^\-l/2* 

4,  Update  Direction  Cosine  Matrix 

0  ’ 

The  direction  cosine  matrix,  C^,  is  updated  (to  the 

n-1 


second  order)  using  the  p 


^n-1/2 


computed  above  viz: 


=  C 


(2-75) 
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2 '  pi 

where  is  the  skew  synunetric  form  of  p  ,  or  wt, 

,  ^  n-1/2  -n-1/2  -O', 2* 


(ll-X/ 

“o'2'  y 

n-1/2/ 


is  the  square  of  the  above  matrix. 


Note:  The  nature  of  the  interpolated  ^^-1/2  is’such  that 
some  portions  of  a  third  and  higher  order  update 
are  incorporated,  while  the  form  is  only  second  order 
(see  Appendix  D). 

4a.  Extrapolate  Updated  Direction  Cosine  Matrix 


O'  0 '  1  0 '  2 ’ 

q,  =  c;,  +  1  c;, 

^  n+l/2  ^  n  L  ^  n-1  °  n-1/2 


+  cO’ 


\Aj 


(2-76) 


O'  .0 

where  C_,  is  C»,  extrapolated  to  the  midpoint  of  the  next 

^  n+l/2  n 

computation  cycle 


and  is  the  update  matrix  added  to  C»,  to  update  it  to 

Q.  L  J  n-1 

C  ,  (see  Equation  2-75) 

^  n 


5.  Orthonomalize  Direction  Cosine  Matrix 

This  operation  is  identical  to  that  performed  in  the 
"baseline"  case.  Equation  (2-56)  is  repeated  below  for  completeness. 


O'  O' 

C21  (ortho)  =  C21 
n  n 


1  C®' 

2  ^2' 


TO* 

^  c°.  -  1 

n 


(2-56) 


10,  Compute  Altitude  and  Vertical  Dampinc 


The  altitude  and  vertical  damping  terms  are  computed  viz: 


frcime 


where 


h  =  h  -  +(  v^'  +  C,  fih  ,  ) 

“n  n-1  \  x^_^/2  ^  } 


At 


\+l/2 

=  h 

n 

^®n+I/2 

*  1 

^^n+1/2 

®n+l/2 

Store  h„ 

®n+l/2 

as  h 

^®n+l/2 

/s 

=  ^n- 

■1/2 

n 


-  h 


h+1/2 


B 


n-1 


At 
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11.  Compute  Components  of  Gravity 

The  components  of  gravity  in  the  computational  (LVWA) 

,  at  t  ,  /-f  are  computed  for  the  WGS  72  Ellipsoid  viz: 
n+1/2 


Vl/2 


=  fc  .  c  (c»:  Y  *  /c°:  ■ 

L  ^0  ^2  \  ^  n+1/2/ 31  \  ^  n+l/2/3i_ 


n.l/2 


=  c 


n+1/2 


-n+1/2 


_  Vl/2  (c  (''^'n+1/2)^. 


(2-78) 


gT  ,  for  i  =  X,  y,  z,  are  the  components  of  gravity  in 

^n+1/2 

computational  (2')  frame  at  t^+1/2* 
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(C®,  )  for  j  =s  1,  2,  3,  are  the  elements  of  the  third 

n+l/2/3j 

row  of  the  transformation  from  the  computational 
frame  to  the  earth-fixed  frame,  extrapolated 

^n+1/2’ 

altitude  extrapolated  to 


Note;  All  the  constants  in  Equation  (2-78)  the  same  as  in 
Equation  (2-62) . 

12 .  Extract  Position  and  Wander  Angle 

This  operation  is  identical  to  that  performed  in  the 

"baseline"  case.  Equations  (2-63,  2-64,  2-65)  are  repeated  below 
for  completeness: 


(2-63) 


(2-64) 

(2-65) 


Note:  Before  is  computed,  the  previous  value  of  a  is 

stored  as  Oq. 

13 .  Form  Wander  Angle  Matrix  and  LVN  Velocities 

The  fundamental  operation  is  identical  to  that  performed 
in  the  "baseline"  case.  Equation  (2-66)  is  repeated  for  complete¬ 
ness. 
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^  =  c^,  vf  (2-66) 

In  addition,  the  sine  and  cosine  of  the  wander  angle  are 
extrapolated  to  t^+1/2* 

6a  =  1/2  (a^  -  a^) 

sin  ct^+1/2  =  sin  a^  +  6a  cos  a^  (2-79) 


“n+1/2  “  “n  "  “n 

where  sin  “^+1/2  “n+1/2  cosine  respectively 

of  the  wander  angle,  extrapolated  forward  to 
mid-computation  cycle. 

3a.  Compute  Angular  Velocities  About  Level  Axes 

The  angular  velocities  about  the  level  axes  of  the 
computational  frame  are  computed  using  the  same  formulae  as  in 
Equation  (2-73),  but  with  all  the  variables  extrapolated  to  tn-H/2* 
Transform  level  components  of  velocity  to  LVN  frame 


9  01  2  * 

^  =  v^  cos  a  V  cin  fV 

yn+1/2  yn+1/2  ^n+1/2  “n+1/2 


(2-80) 


2  =  v^ ' 

^^n+1/2  yn+1/2 


“n+1/2 


cos  a 


n+1/2 


n+1/2 
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Compute  E  and  N  components  of  angular  velocity 

,2 


-v: 


(Dt- 


'n+1/2 


''n+1/2 


^n+l/2< 


ro  (1  -  e 

) 

c®'  ■ 

( 2V1/2; 

r 

31 

3/2J 

(2-81) 


CO. 


N 


n+1/2 


n+1/2 


*'n+'l/2 


1  -  (c®!  Y 

\  ^  n+l/2/r 


1/2- 


n+1/2/ 32 

Transform  angular  velocity  to  computational  frame 


n+1/2 


A  0 


^n+1/2 


=  0). 


®n+l/2  “n+1/2  "  X+i/z  ®  “n+1/2  (2-82) 


n  +1/2 


=  to. 


E 


sing 


n+1/2 


h+1/2 


+  (0. 


N 


cos  a 


n+1/2 


n+1/2 


Note : 


(a)  The  variable  definitions  accompanying  Equation 

(2-73)  apply  here  -  only  the  time  has  been 
advanced  from  t^_2/2  *'n+l/2  * 

(b)  The  values  of  sin  01^4.2/2  “n+1/2 

stored  in  locations  for  the  "extrapolated  sin- 
cos  of  g"/  and  will  be  used  as  sin  ^nd 

cos  o‘n_2/2  Equation  2-73  is  used  on  the  next 

computation  cycle. 

/  O' 

(c)  A  similar  comment  to  (b)  above,  applies  to \p2' n+1/2 
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The  earth's  rate  signals  are  computed  in  the  same 

manner  as  for  the  "baseline"  case,  (Equation  (2-57))  »  except  that 

0  * 

the  extrapolated  direction  cosine  matrix,  C- ,  ,  is  employed. 

^  n+1/2 


2! 

ft  I 

n+1/2 


/_0’  \t  O' 

~  1^2 '  I  —0  0 ’ 

V  ^  n+1/2 


(2-83) 


=  ®^”^n+l/2,-'=°®^n+l/2  ®^”%+l/2,  °°®^n+l/2  ‘=°®“n+l/2 


7.  Compute  Gyro  Torquing  Signals 

2 ' 

Gyro  torquing  signals,  (»)«  oi  •  computed  in 

n+1/2 

the  identical  manner  to  that  employed  in  the  "baseline"  case. 
Equation  (2-58)  except  that  the  variables  are  extrapolated  to 

*^n+l/2  • 


—0  2 ' 

n+1/2 


2'  ■  .2' 

Wrt  ft ,  '  2  ' 

n+1/2  n+1/2 


(2-84) 


where  “o', 2 


as  computed  in  Equation  (2-81) 


8.  Compute  Angular  Velocity  (for  ^  x  v) 

Angular  velocity  for  the  Coriolis  and  centripetal  terms, 
computed  as  in  Equation  (2-59)  for  the  "baseline"  case, 
except  that  the  extrapolated  variables  are  used: 


liln+l/2=  ^0,2 -O' ° 'n+1/2 


(2-85) 


/ 


9.  Compute  (w  x  v)  At  (for  velocity  update) 

The  Coriolis  and  centripetal  portion  of  the  velocity 
update  is  computed  in  the  same  manner  as  in  Equation  (2-6  0)  for 
the  "baseline"  case,  except  that  the  extrapolated  values  (to 
are  employed. 


-(a 


n+1/2 


— n+1/2 


At 


^  n+1/2 


+  2n 


2' 

0,0 


n+1/2 


2' 

-n+1/2 

(2-86) 


General  Note:  The  extrapolated  variables  computed  by 

Equation  (2-77  '  through  ( 2-86)  f  at  t^,  become 
the  interpolated  variables  used  in  Equations 
(2-69)  through  (2-73),  at 


At 
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2.5  Attitude  Computations 


Attitude  computations  for  the  three  IMU  types,  all  employing 

a  local  vertical  wander  azimuth  (LVWA)  computational  frame,  differ 

only  in  the  manner  of  constructing  the  transformation  from  the  body 

c  2 ' 

frame  to  the  LVWA  computational  frame  Cj^  or  Cg  . 

2.5.1  Local  Vertical  Wander  Azimuth  IMU 

A  four  gimbal,  local  vertical  IMU  is  considered  since  attitude 
may  be  read  out  directly^in  the  three  gimbal  case.  In  this  case, 

Cg  is  the  LVWA  gimbal  angle  matrix.  The  generation  of  this  matrix 
is  described  in  detail  in  Appendix  A,  Section  A. 4.7  of  this  volume. 


2.5.2  Space  Stablized  IMU 

All  gimbaled,  SS  IMU's  have  four  gimbals.  The  SS  gimbal  angle 
matrix  or  transformation  from  the  body  frame  to  the  space  stable 
platform  frame,  or  Cg®,  is  described  in  detail  in  Appendix  A, 
Section  A. 4. 6  of  this  volume.  However,  this  is  only  the  first  step 
in  generating  Cg'  for  a  space  stable  IMU  with  a  LVWA  computational 
frame.  The  total  transformation  is  given  by: 

cj  =  C°  cf  ci  cl 

b  e  1  p  b 


or 


C 


10 

5 


where  C 


0 

10 


or 


is  the  space  stable  alignment  matrix  (a  constant 
for  this  study)  -  see  Appendix  A,  Section  A. 4. 8 
of  this  volume. 


C^'or  C®  is  the  single  axis  rotation  representing  the  inertial 
to  earth  fixed  transformation  -  see  same  section  as 
above . 

CqI  or  C®  is  the  transpose  of  the  LVWA  "direction  cosine  matrix 
-  see  Appendix  A,  Section  A. 4. 5  of  this  volume. 
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2.5.3  Strapdown  IMU 


The  body-to-computational  frame  transformation,  C°,  is  an 
integral  part  of  the  (high  speed)  strapdovm  computations.  Its 
generation  is  described  in  detail  in  Section  2.3.3  of  this  volume. 

2.5.4  Attitude  Extraction 

This  operation  is  common  to  all  IMU  types  with  a  LVWA  computa 
tional  frame,  and  is  described  in  detail  in  Sections  A. 4.4  and 
A. 4. 9  of  this  volume. 

It  should  be  noted  that  roll  and  yaw  are  indeterminate  when 
pitch  is  +  90°. 


4 
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2.5.5  Attitude  Predictor-Filter 

The  attitude  predictor  filter  accepts  the  computed  attitude 
angles  (roll,  pitch  and  heading)  as  inputs  and  outputs  filtered/ 
predicted  values  of  the  attitude  angles  their  angular  rates  and 
angular  accelerations.  It  employs  precomputed  gains,  selected  on 
the  basis  of  the  observation  residuals  (the  difference  between 
the  computed  and  estimated  attitude  angles) .  If  the  residual  is 
less  than  a  preassigned  maximum,  the  gains  are  incremented  towards 
the  steady  state  values;  conversely,  if  the  residual  equals  or 
exceeds  the  maximum,  gains  are  decremented  toward  the  initial 
values,  where  complete  reliance  is  placed  on  the  computed  attitude 
angle.  The  procedure  is  repeated  for  each  attitude  angle. 

A  block  diagram  of  the  filter  is  presented  below  (for  a  single 


Figure  2-11.  Attitude  Predictor-Filter  Block  Diagram 
(Single  Axis) 

where  6.,  is  the  computed  (measured)  attitude  angle  at  t  . 

M  “ 

n 

9“  is  the  estimated  attitude  angle  at  t  ,  prior  to  the 
E  II 

update. 

e  =  6..  -  6„  is  the  observation  residual  at  t  . 

r  n 

n  n  n 

K  is  the  3x10  gain  matrix. 
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ijn  column  of  the  gain  matrix  from  the  gain  select 

logic,  where  =  jj^.j^+l  unless  K  =  10. 

M=  {1  0  0}  is  the  measurement  matrix 


$  is  the  state  transition  matrix 

2 

1  At 


where  $  A 


At' 

2 


0  1  At 

_0  0  1  J 


Ain  “  -j  ^®n  update  to  the  attitude  state, 

T 


{sej,  66  59  )  . 

n  n  n 
,T. 


— E  “  ®E  ^  estimated  attitude  state  at  t  , 

n  n  n  n  n' 


n  n  n 
prior  to  the  update, 

Ae  “  ^®E  ®e  ®p  is  estimated  attitude 

n  n  n  n  n  n  '*^n 

state  at  t^,  after  the  upate. 

At  is  the  attitude  computation  cycle. 


Three  passes  through  the  filter  are  required  to  update  all  three 
attitude  angles  and  their  derivatives,  which  are  then  stored  in  a 
3x3  attitude  state  matrix. 

It  should  be  noted  that  the  particular  gain  matrix,  K,  was 
that  considered  applicable  for  the  SPN/GEANS,  and  may  only  be  applied 
when  attitude  is  computed  at  32  Hz.  Generally,  the  gains  are  obtained 
from  a  two  step  simulation  program.  In  the  first  step  the  vehicle 

the  estimated  initial  errors  in  angular  position,  velocity, 
and  acceleration,  the  actual  and  estimated  encoder  noises,  the 
iteration  time,  the  ratio  of  the  iteration  to  the  desired  truncation 
time,  the  iterations  from  which  gains  are  to  be  stored,  and  several 
other  control  parameters  are  input.  The  run  is  performed,  including  a 
statistical  analysis  of  the  errors,  using  a  recursive,  exponentially 
age  weighted,  least  squares  filter.  In  the  second  step,  the  run 
is  repeated  using  the  precomputed  gains  (i.e.  the  same  filter  config- 
previously  described)  and  the  instantaneous  and  statistical 
errors  are  compared.  A  number  of  repetitions  of  the  process,  with 
judicious  variation  of  parameters  should  lead  to  a  best  gain  matrix. 
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for  the  vehicle  dynamics,  encoder  characteristics  and  iteration  time 
This  program  does  not  currently  exist  at  CSDL. 

The  filter  equations  are  mechanized  in  the  following  manner 
(for  a  single  axis) : 


Note  that  e„  is  et  one  cycle  (At)  later 

— ti  JCi 

n-1  n 

2)  Form  observation  residual 


3)  Select  gain  column  i 

See  Flowchart  (Figure  2’-12) 

4)  Update  attitude  state 


The  above  are  the  filtered  values  at  t^.  In  essence  the 
above  procedure  is  repeated  twice  more. 
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SECTION  3 


SUMMARY  OF  INS  NAVIGATION  COMPUTATIONS 

3.1  Introduction 

This  Section  contains  a  general  functional  description  of 
the  INS  navigation  software  mechanizations,  based  on  the  survey 
results  presented  in  Section  1. 

The  following  INS  configurations  are  included  in  this 
description : 

1.  INS  with  a  local  level  stabilized  platform 

2.  INS  with  a  space  stabilized  platform 

3.  Strapdown  INS 

The  computational  frames  included  in  this  description,  are: 

1.  Local  level,  geodetic,  wander  azimuth 

2.  Space  stabilized 

The  resultant  six  types  of  computations  are  categorized  in 
Figure  3-1.  The  figure  niambers  shown  in  the  tabulation  refer  to 
the  block  diagrams  of  the  navigation  computations,  presented  in 
this  Section. 

The  proposed  standardized  symbology  of  frames  and  transfor¬ 
mations,  presented  in  Section  6,  is  used  in  the  overview  descri¬ 
bed  in  this  section. 

3.2  Summary  and  Conclusions 

The  general  functional  description  of  INS  software  mechanize 
tion  is  used  to  illustrate  the  commonality  and  differences  in 
navigation  computations  for  three  types  of  INS  configurations 
local  level,  a  space  stabilized  and  a  strapdown  INS).  Both  the 
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INS  CONFIGURATION 

LOCAL 

LEVEL 

STABILIZED 

PLATFORM 

SPACE 

STABILIZED 

PLATFORM 

STRAPDOWN 

COMPUTATIONAL 
f  FRAME 

LOCAL  LEVEL 

FIG.  3-3,  3-4 

FIG.  3-3,  3-5 . 

FIG.  3-3,  3-6 

SPACE  STABILIZED 

FIG.  3.7,  3-8 

FIG.  3-7, 3-9 

FIG.  3-7,  3-10 

Figure  3-1.  Categorization  of  the  INS  Computations 


local-level  wander-azimuth  and  the  space-stabilized  computational 
frames  are  included  in  this  description. 

The  commonality  of  navigation  computations  of  position  and 
velocity  in  both  computational  frames  starts  with  the  velocity 
increments  sensed  by  the  accelerometers  and  resolved  along  the 
computational  frame  axes  and  ends  with  the  position  and  velocity, 
computed  in  the  local  geographic  frame . 

The  differences  in  navigation  computations  in  both  computa¬ 
tional  frames  for  the  three  types  of  INS  configurations  are  re¬ 
presented  by  the  following  computations; 

1.  Transformation  of  the  velocity  increments  sensed  by 

the  accelerometers  from  the  accelerometers  axes  frame  to 
the  computational  frame.  The  form  of  the  transformation 
matrix  is  a  function  of  the  INS  type. 

2.  Computation  of  the  gyro  torquing  signals  is  required  for 
the  INS  with  local-level  stabilized  platform. 

The  attitude  computations ,  irrespective  of  the  computational 
frame  used  in  the  navigation  computations,  require  determination 
of  the  transformation  from  the  vehicle  body  axes  frame  to  the 
local-geodetic,  north-pointing  frame. 
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For  the  INS  with  a  giinballed  platform,  the  gimbal  angles  are 
used  to  compute  the  transfomation  from  the  vehicle  body  frame  to 
the  platform  frame.  The  transformation  from  the  platform  frame 
to  the  local-level,  geodetic,  north-pointing  frame  is  determined 
using  the  computed  navigation  parameters.  For  the  strapdown  INS, 
the  transformation  from  the  body  frame  to  the  local-level,  geodetic, 
north-pointing  frame  is  computed  using  the  angular  velocities 
sensed  by  the  gyros  and  the  computed  navigation  parameters. 

Selection  of  the  computational  frame  used  in  the  navigation 
computations  determines  the  format  of  navigation  parameters  com¬ 
putations  required  for  the  attitude  computations. 

3.3  Frame  Definition 

Definition  of  the  coordinate  frames  employed  in  this  section 
presentation  is  shown  in  Figure  3-2.  The  frames  definition  is 
based  on  the  proposed  standardized  symbology  presented  in  Section 

6. 


3. 4  Position  and  Velocity  Computations  in  Local-Level  Frame 

Figure  3-3  presents  a  block  diagram  of  the  navigation  compu¬ 
tations  of  position  and  velocity  in  the  local-level,  geodetic, 
wander- azimuth  computational  frame.  This  part  of  the  computations 
is  common  for  the  local  level  INS,  the  space  stabilized  INS  and 
for  the  strapdown  INS. 

The  velocity  increments  AV,  sensed  by  the  accelerometers  and 
resolved  along  the  axes  ¥2,221  are  combined  with  the  V/R  terms 
and  with  the  Coriolis  correction  terms.  The  computed  horizontal 
velocity  is  resolved  through  the  wander  angle,  a,  into  the  east 
and  the  north  components.  Computation  of  the  vertical  velocity 
component  requires  the  magnitude  of  the  local  gravity.  In  addition, 
the  barometric  altitude,  hg,  is  used  in  a  third-order  damping 
loop  to  bound  the  vertical  channel  computation  errors.  The  com¬ 
puted  horizontal  velocity  is  used  in  the  computation  of  the  angular 
rate  jjIq  2,  computational  frame,  2'  ,  with  respect  to  the 
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SPACE  STABLIZED  REFERENCE 

EARTH  FIXED  REFERENCE,  AT  t  =  0,  O' FRAME  COINCIDES  WITH  0  FRAME 
EARTH  FIXED,  FOR  LONGITUDE  X=  0,  1  FRAME  COINCIDES  WITH  0'  FRAME 
LOCAL  GEODETIC  UP,  EAST,  NORTH 
LOCAL  GEODETIC,  WANDER  AZIMUTH,  WANDER  ANGLE  =  a 
^  ^  ^  AIRCRAFT  BODY  Xg  UP,  Yg  ALONG  RIGHT  WING,  Zg  ALONG  FUSELAGE  (FORWARD) 

FOR  ATTITUDE  ANGLES  AND  WANDER  ANGLE  =  0,  THE  5  FRAME  COINCIDES  WITH  THE  2  FRAME 


X2,Y2,Z2 

X2.Y2v?2' 


Figure  3-2.  Definition  of  Axes  Frames 
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earth  fixed  frame,  0  »  The  jaJq,  is  used  to  update  the  direction 
cosine  matrix  of  transformation,  C^i',  between  the  frames  2*  and 

and  O'.  The  updating  is  based  on  solution  of  the  differential 

.  *  O'  0 * 

equation  C21  =  C21  The  latitude,  L,  longitude,  A  + 

and  the  wander  angle,  a,  are  computed  from  the  C®!  matrix  terms. 

Figure  3-4  presents  additional  computations  in  the  local 
level  frame  required  for  an  INS  with  a  local  level  platform 
stabilization.  The  gyro  torquing  signals  are  computed  using  the 
C®,  and  the  ‘‘Jq’  2' 

Figure  3-5  presents  additional  computations  in  the  local 
level  frame  required  for  an  INS  with  a  space  stabilized  platform. 
The  velocity  increments  ^  sensed  by  the  accelerometers  mounted 
on  the  space  stabilized  platform  are  transformed  from  the  plat¬ 
form  axes  frame,  10,  to  the  computational  frame,  2',  using  the 
updated  directional  cosines  matrix  =  C^'c^  ^O'^o'^lO* 

Figure  3-6  presents  additional  computations  in  the  local 

level  frame  required  for  a  strapdown  INS.  The  velocity  increments 

sensed  by  the  accelerometers  mounted  on  the  aircraft  body 

transformed  from  the  body  frame,  5,  to  the  computational 

frame,  2'  using  the  direction  cosines  transformation  matrix, 

2  *  .  2 '  . 

C5  .  The  matrix  is  computed  from  the  quaternion,  g.  The 

quaternion,  g,  is  computed  and  updated  using  the  angluar  velocity 
“0,5  the  gyros  and  the  angular  velocity  of  the 

computational  frame,  2',  with  respect  to  the  inertial  frame,  0, 
computed  in  the  2*  frame  and  transformed  to  the  5  frame. 

Position  and  Velocity  Computations  in  Space-Stabilized 
Frame ^  ^  - 

Figure  3-7  presents  a  block  diagram  of  the  navigation  com- 
P'^tations  in  the  space— stabilized  computational  frame.  This 
part  of  the  computations  is  common  for  the  local  level  INS,  the 
space-stabilized  INS  and  the  strapdown  INS. 

The  velocity  increments,  sensed  by  the  accelerometers 

and  resolved  along  the  space-stabilized  axes  frame,  0,  and  com¬ 
bined  with  the  gravity  contributions,  £AT  and  with  the  barometric 
damping  term,  K^^Ah.  The  computed  inertial  velocity,  V®,  is  used 
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GRAVITY 

MODEL 


Figure  3-7.  Commonality  of  Navigation  Computations  in  a  Space 
Stabilized  Frame  -  General  Block  Diagram 


to  compute  the  local  geodetic  velocity  components  V  »  '  ^7 

^2  *  ^  2  *  .  2  * 

The  is  also  used  with  the  barometric  damping  term,  in 

the  computations  of  the  local  geodetic  positon,  components  L, 

X,  h.  The  R^is  also  used  in  the  gravity  computations  and  in 
the  geodetic  velocity  computations. 

Figure  3-8  presents  additional  computations  in  the  space- 
stabilized  frame  required  for  an  INS  with  a  local  level  stabil¬ 
ized  platform.  The  velocity  increments,  sensed  by  the 

accelerometers  mounted  on  the  platform  are  transformed  from  the 
platform  frame,  10,  to  the  space-stabilized  computational  frame, 

0,  using  the  updated  directional  cosines  matrix,  ^10  “  ‘^O'^l  ^2  ^10 
In  addition,  the  required  gyro  torquing  signals  are  computed. 

Figure  3-9  presents  additional  computations  in  the  space- 
stabilized  frame  required  for  an  INS  with  a  space  stabilized  INS. 
The  velocity  increments,  AvlO,  sensed  by  the  accelerometers 
mounted  on  the  space  stabilized  platform,  are  transformed  to  the 
space  stabilized  axes  frame,  0,  using  a  constant  transformation 
matrix 

Figure  3-10  presents  additional  computations  in  space- 
stabilized  frame  required  for  a  strapdown  INS.  The  velocity  in¬ 
crements  sensed  by  the  accelerometers  mounted  on  the  aircraft 

body  are  transformed  from  the  body  axes  frame  to  the  computa¬ 
tional  frame  using  the  direction  cosine  transformation  matrix  C^. 

The  matrix  is  computed  from  the  quartenion,  g.  The  quartneion 

^  .5 

is  computed  and  updated  using  the  angular  velocity  ^  sensed 

by  the  gyros. 

3 . 6  Attitude  Computations 

Figures  3-11,  3-12,  3-13  present  block  diagrams  of  the 
aircraft  attitude  computations  used  either  with  the  local-level 
computational  frame  or  with  the  space-stabilized  computational 
frame.  The  attitude  angles  are  computed  by  solving  the  follow¬ 
ing  matrix  equation: 

Attitude  angles  matrix  =  Transformation  matrix  from  the 

aircraft  body  axes  to  the  computation 

2  * 

frame  . 
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LOCAL  LEVEL  STABILIZED  PLATFORM. 


Figures  3-8,  3-9,  3-10.  Additional  Computations  in  the  Space-Stabilized  Frame  Required 

for  Various  INS  Configurations  -  General  Block  Diagram 


LOCAL  LEVEL,  GEODETIC,  WANDER  AZIMUTH  INS 


cm'  m 


3-11 


Figures  3-11,  3-12  and  3  13.,  Attitude  Computations  -  General  Block  Diagram 


The  attitude  angles  matrix  is  a  function  of  the  aircraft 

roll,  pitch  and  a  sum  of  yaw  and  wander  angles.  The  transformation 
2 ' 

matrix,  ,  for  the  gimballed  type  of  the  INS,  with  either  the 
local-level  (Figure  3-11)  or  the  space-stabilized  platform  (Fig¬ 
ure  3-12)  consists  of  the  transformation  from  the  aircraft  body 
axes  frame  to  the  platform  axes  frame  followed  by  the  transfor¬ 
mation  from  the  platform  frame  to  the  computational  frame.  The 
first  matrix  is  computed  from  the  gimbal  angles  and  the  second 
matrix  is  obtained  from  the  navigation  computations  shown  in 
Figures  3-3,  3-5,  3-7,  3-8. 

For  the  strapdown  INS  (Figure  3-13)  the  transformation  from 
the  body  axes  frame,  5,  to  the  local,  wander-azimuth  computational 
frame,  2',  is  obtained  using  the  angular  body  rates  with  respect 

C 

to  the  inertial  frame,  sensed  by  the  strapdown  gyros,  o)^  _,  and 

the  angular  rate  of  the  computational  frame  with  respect  to  the 

.  .  2' 

inertial  frame,  jHq  21 /  obtained  from  the  navigation  computations. 
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4.0  SURVEY  OF  SOFTWARE  INTERFACES 


4.1  Introduction 

A  survey  of  software  interfaces  between  the  INS  navigation 
computations  and  other  avionic  system  computations  was  performed 
to  obtain  technical  data  required  for  design  of  the  computer 
errors  simulation  program,  described  in  Volume  III  of  this  report. 
The  survey  results  were  used  to  obtain  the  following  data. 

a.  The  accuracy,  the  resolution  and  the  data  rate  of  the 
inertially  sensed  data  required  for  the  avionic  compu¬ 
tations. 

b.  The  characteristics  of  the  navigation  aids  measurements 
used  in  the  INS  navigation  computations  updating. 

The  following  avionic  computations  are  included  in  this 
survey: 

a.  A-7D  INS  Weapon  Delivery  and  Flight  Control  Computatibns 

b.  A-7D  INS  Navigation  Displays 

c.  A-7D  INS  Air  Data  Computations 

d.  C-5  INS  Navigation  Computations  Updating 

e.  Electronically  Agile  Radar  (EAR)  Radar  Antenna  Motion 
Compensation  Computations 

The  surveyed  dociunentation  was  limited  to  the  reports  on 
file  at  CSDL  at  this  time.  The  results  of  the  survey  are  pre¬ 
sented  in  Tables  4-1  to  4-7. 

4 . 2  Summary  and  Conclusions 

A  survey  of  the  software  interfaces  between  the  INS  naviga¬ 
tion  confutations  and  avionic  systems  confutations  summarized  in 
Table  4-1,  revealed  typical  accuracy,  resolution  and  data  rate  of 
the  inertially  sensed  data  required  for  the  avionic  systems 
computations . 
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Table  4-1  Survey  Summary  of  INS  Software  Interfaces 
With  Avionic  Computations 
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The  inertially  sensed  data  consists  of  linear  acceleration, 
attitude  and  possible  attitude  rate.  The  velocity  and  position 
are  derived  from  the  inertially  sensed  data.  The  linear  accelera¬ 
tion,  data  sensed  by  the  accelerometers  is  in  the  form  of  pulses 
representing  velocity  increments.  The  attitude  data  is  obtained 
from  the  gimbal  angle  readouts.  The  attitude  rate  data  is  ob¬ 
tained  either  by  differentiation  of  the  attitude  data  or  it  is 
sensed  directly  by  the  body  mounted  (strapdown)  rate  gyros. 

The  survey  results  indicate  that  severe  resolution  and  rate 
requirements  for  the  linear  acceleration  and  the  attitude  data 
are  imposed  by  the  antenna  motion  compensation  computations  em¬ 
ployed  in  the  synthetic  aperture  radar  operation  (SAR) ,  as  shown 
in  Table  4-1.  The  required  velocity  increments  resolution  is 
0.00125  ft/sec  with  a  data  rate  of  256  Hz  for  the  acceleration 
range  of  +2g.  The  required  level  indication  resolution  is  40  arc- 
sec  (la) ;  the  required  azimuth  resolution  is  2  arc-min  (la)  and 
the  required  rate  of  the  attitude  data  is  256  Hz.  The  data  rate 
requirements  are  met  by  interpolating  the  inertial  sensor  data 
between  8  Hz  navigation  computation  updates. 

The  A-7D  navigation  computations  require  a  0.032  ft/sec  resolu 

tion  of  the  velocity  increments  with  a  data  rate  of  5  Hz  for  an 

_2 

acceleration  range  of  10  g  to  lOg. 

The  A-7D  weapon  delivery  computations  require  the  velocity 
increment  data  in  the  navigation  frame  with  a  data  rate  of  25  Hz.. 

The  required  attitude  resolution  is  2  arc-min  (la)  with  a  data 
rate  of  25  Hz. 

The  A-7D  flight  control  computations  require  velocity  in¬ 
crement  data  in  the  aircraft  body  frame  with  a  data  rate  of  50  Hz 

-2 

to  100  Hz  for  an  acceleration  range  10  g  to  lOg. 

The  A-7D  navigation  confutations  data  requirements  are 
sufficient  for  the  display  computations. 

The  A-7D  inertially  sensed  data  requirements  are  shown  in 
Table  4-2. 
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The  A-7D  INS  navigation  computations  use  barometric  altitude 
data  to  stabilize  the  vertical  channel  computations.  The  air  data 
computer  (ADC)  is  used  to  generate  the  barometric  altitude  data, 
the  true  and  the  indicated  air  speed  data  and  the  Mach  number 
data.  The  true  air  speed  data  is  used  in  computation  of  the  wind 
velocity.  The  indicated  air  speed  data  is  used  for  the  head  up 
display  (HUD) .  The  Mach  number  is  used  in  the  weapon  delivery 
and  in  the  automatic  flight  control  computations.  The  air  data 
range,  accuracy  and  resolution  are  shown  in  Table  4-5. 

A  suirvey  of  the  navigation  computations  updating  by  the 
navigation  aids  enployed  in  C-5  INS  indicates  that  the  Kalman 
filter  computations  require  2200  words  of  28  bits.  The  computa¬ 
tions  enploy  floating-point  arithmetic  with  28  bit  words  shared 
equally  by  mantissa  and  exponent.  The  sampling  rate  of  the 
measurements  is  of  the  order  of  one  sample  per  second  and  the 
Kalman  filter  updating  cycle  is  of  the  order  of  minutes.  The 
measurements  samples  are  averaged  over  the  Kalman  computational 
cycle.  The  navigation  aids  measurements  provide  an  update  of  the 
computed  position,  velocity  and  attitude.  The  measurements  are 
also  used  to  update  the  three  gyro  biases,  the  vertical  acceler¬ 
ometer  bias,  the  doppler  radar  measured  drift  angle,  the  computed 
ground  speed  scale  factor  and  the  barometric  altimeter  bias. 

The  range  and  accuracy  of  the  typical  navigation  aids  mea¬ 
surements  employed  in  the  aircraft  navigation  computations  (not 

necessary  in  the  C-5  INS)  are  shown  in  Table  4-6 . 
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A-7D  INS  Weapon  Delivery  and  Flight  Control  Computations 

The  weapon  delivery  and  aircraft  flight  control  computations 
require  the  following  inertially  derived  data: 

a.  Linear  Acceleration 

b.  Velocity 

c.  Position 

d.  Attitude 

e.  Attitude  Rate 

The  inertial  instruments  sense  directly  the  linear  accelera¬ 
tion,  the  attitude  and  the  attitude  rate.  The  inertially  sensed 
data  is  used  to  compute  the  velocity  and  the  position.  In  some 
applications  the  attitude  rate  may  be  confuted  from  the  sensed 
attitude.  In  A-7D  INS  the  attitude  rate  (the  aircraft  body  rate) 
is  obtained  in  analog  form  from  the  strapdown  (body  mounted)  rate 
gyros . 

Table  4-2  presents  the  range,  the  resolution  and  the  rate 
of  the  inertially  sensed  data  required  for  the  A-7D  weapon 
delivery  and  for  the  flight  control  computations. 


4.3.1  Attitude  Data 

In  A-7D  INS  the  vehicle  attitude  is  obtained  from  the  gimbal 
angles  measurements,  providing  the  aircraft  pitch,  roll  and  yaw  in 
relation  to  the  geodetic  local-level,  north-pointing  reference 
frame.  The  angle  data  is  read  out  by  synchros  with  2  arc-min  (rms) 
accuracy  and  it  is  used  either  directly  or  after  A/D  conversion 
in  the  avionic  system  computations.  The  attitude  data  is  measured 
for  the  aircraft  attitude  changes  up  to  30  deg/sec  in  pitch  and 
yaw  and  up  to  200  deg/sec  in  roll.  To  prevent  an  excessive  mea¬ 
surement  error,  the  attitude  data  sampling  rate  25  samples/ 
sec  is  used.  A  summary  of  the  typical  attitude^data  utilization 
in  A-7D  avionic  systems  is  shown  in  Table  4-3 
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Table  4-3  Typical  Attitude  Data  Utilization 

(17) 

in  A-7D  Avionic  Computations 


MEASUREMENT  OR 
COMPUTATION 

APPLICATION 

MEASUREMENTS 

REQUIRED 

DATA 

RATE 

NAV  Frame  to  Body  Frame 
Transformation 

Target  LOS  Components  transform 
•  All  Bombing  Modes 

Pitch,  Roll,  Yaw 

25 

Impact  Point  Components  transfor¬ 
mation 

•  Air-to-Gnd  Gun/Rocket  Mode 

•  Bomb  Fall  Line 

25 

Gun  Line  Aim  Angle  Transformation 
•  Air-to-Air  Gun/Rocket  Mode 

25 

FPM 

•  Velocity  Components 

Transform 

25 

Target  El,  Az  Angle  Transform 

•  ITV  Bombing 

•  FLIR  Bombing 

Body  Frame  to  NAV  Frame 
Transformation 

Target  LOS  Angle  Transformation 

•  FLIR  Bombing 

•  ITV  Bombing 

Pitch,  Roll,  Yaw 

25 

Reticle  El,  Az  Angle  Transformation 

•  Visual  Attack  Bombing  Mode 

•  Visual  Attack  Offset  B  M 

* 

Target  LOS  El  Rate,  Az  Rate 
in  Body  Frame 

Body  Rate  Compensation  of  FLIR 
and  ITV 

Pitch,  Roll,  Yaw 

25 

G  Vector  WRT  Body  Frame 

Weapons  delivery  Computation 

Pitch,  Roll,  Yaw 

25 

Sin  &  Cos  of  Roll 

HUD  display  attitude  positioning 

Roll 

Pitch  Angle 

Pitch  word  to  HUD 

Pitch 

25 

Roll,  Pitch  Attitude 

•  Attitude  Indication  for  VSD  (ADI) 

•  Pitch  and  lateral  steering 
commands  from  Flight  Director 
Computer  (FDC) 

Roll,  Pitch 

* 

Pitch,  Roll  Error  Commands 

FCS  attitude  hold  error  commands 
for  autopilot 

Pitch,  Roll 

Heading 

Steering  Commands  for  VSD,  HSD, 
HUD 

Pitch,  Roll,  Yaw 

* 

Attitude 

FCS  attitude  compensation 
calculations 

Pitch,  Roll,  Yaw 

* 

•analog  data 
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4.3.2  Attitude  Rate  Data 


In  A-7D  the  aircraft  attitude  rate  data  is  obtained  from 
the  strapdown  gyros  that  are  a  part  of  the  Flight  Control  System 
(FCS) .  The  data  is  in  analog  form  with  15  to  30  Hz  bandwidth. 
Resolution  of  the  pitch  and  yaw  rate  gyros  data  is  0.01  deg/sec 
and  resolution  of  the  roll  gyro  data  is  0.05  deg/sec.  The 
FCS  computations  including  the  computations  for  the  pitch 
and  roll  axes  Control  Augmentation  System  (CAS)  and  the 
yaw  axis  Stability  Augmentation  System  (SAS)  are  the  principal 
users  of  the  attitude  rate  data.  Outside  the  FCS  the  attitude 
rate  data  is  required  for  the  Forward-Looking  Radar  (FLR)  compu¬ 
tations  when  operating  in  terrain— following  or  terrain-avoidance 
mode.  The  atittude  rate  data  is  used  to  obtain  the  turn  rate 
information  for  offset  of  the  azimuth  pointing  of  the  radar 
antenna  during  the  turn  to  indicate  to  the  pilot  where  he  is 
going.  The  turn  rate  is  also  displayed  on  the  Attitude  Director 
Indicator  (ADI) .  The  aircraft  pitch  and  yaw  rates  could  be  also 
used  in  computation  of  gun— line  lead  angle  for  air-to-air  weapon 
delivery  at  fixed  range  using  a  servoed  aiming  vehicle  which  the 
pilot  maintains  on  target. 

A  summary  of  the  representative  type  of  the  avionic  confu¬ 
tations  utilizing  the  attitude  rate  data  is  shown  in  Table  4-4  , 

4.3.3  Linear  Acceleration  Data 

The  linear  acceleration  (specific  force)  is  sensed  by  the 
torque-restrained,  pendulum  type  accelerometers,  mounted  on  the 
IMU  platform.  The  accelerometer  output  pulses  represent  velocity 
increments  at  0.032  ft/sec/pulse  (low-gain  scaling,  used  during 
the  flight) .  The  overall  specific  forces  range  sensed  by  the 
accelerometers  is  from  10  g  to  lOg.  The  required  data  rates  are 
5  Hz  for  the  navigation  computations,  25  Hz  for  the  weapon  delivery 
computations  and  50  Hz  to  100  Hz  for  the  FCS  computations. 
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Table  4-4 


Typical  Attitude  Rate  Data  Utilization 

(17) 

in  A-7D  Avionic  Computations 


Measurement  or 
Computation 

Application 

Data  Porm 
Required 

DATA 

RATE 

(Samples/sec) 

Body  Pitch  Rate 

PCS:  Pitch  axis  CAS 

Body  pitch  rate 

*BW;  15-30  cps 

Body  Roll  Rate 

PCS:  Roll  axis  CAS 

Body  roll  rate 

*BW:  15-30  cps 

Body  Yaw  Rate 

PCS:  Yaw  axis  SAS 

Body  yaw  rate 

*BW:  15-30  cps 

Turn  Rate 

PLR  offset  azimuth 
pointing  during  turn 

Body  yaw  rate 

*  25 

Turn  Rate 

VSD  indication 

Body  yaw  rate 

^  5 

Aiming  Lead  Angle 

Gun-Line  Lead  angle 

Body  pitch  & 
yaw  rate 

25 

Body  attitude  Rate 
Compensation 

Rate-aided  PLR  attitude 
stabilization 

Platform  Pitch 
Gimbal  Rate; 
Platform  Roll 
Gimbal  Rate 

or 

Body  Pitch  rate 
Body  Yaw  rate 

Body  attitude  Rate 
Compensation 

Rate-aided  boresight 
stabilization  for  PLIR 
and  ITV 

Body  pitch  rate 
Body  yaw  rate 

‘ANALOG  DATA 
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In  the  A-7D,  acceleration  data  for  navigation  functions  is 
accumulated  and  corrected  for  Coriolis,  centripetal,  and 
gravity  accelerations  to  yield  a  high-accuracy  velocity  update  ■ 
five  times  a  second.  The  weapon  delivery  calculations,  however, 
require  more  frequent  velocity  information.  To  satisfy  this 
latter  requirement,  the  raw  accelerometer  data  is  sairpled  25  times 
a  second,  it  is  corrected  for  gravity  acceleration  and  it  is  added 
incrementally  to  the  latest  velocity  update,  thus  providing  five 
velocity  interpolations  between  each  navigation  velocity  update. 

For  the  FCS  computations  the  acceleration  data  is  sanpled 
at  a  50  to  100  samples  per  second  rate  and  it  is  tranformed  from 
the  platform  frame  to  the  aircraft  body  frame. 

4.4  A-7D  Navigation  Displays  Computations 

The  following  major  navigation  displays  are  employed  in 

A-7D: 

1.  Attitude  Director  Indicator  (ADI) 

2.  Horizontal  Situation  Indicator  (HSI) 

3.  Head- up  Display  (HUD) 

4.  Forward  Looking  Radar  (FLR) 

5.  Projector  Map  Display  System  (PMDS) 

Ik 

A  listing  of  parameters  presented  in  each  display  is  given 

below 

ADI 

Roll,  Pitch  Attitude 
Magnetic  Heading 

Horizontal,  Vertical  Steering  Pointers 
Displacement  Pointer 
Slip  Indication 
Rate-of-turn  Indicator 
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HSI 


Range  Display 
Compass  Card 
Settable  Heading  Marker 

Course  Pointer  and  Settable  Digital  Course  Readout 
To  -  From  Arrow 
Course  Deviation  Bar 

HUD 

Flight  Path  Angle,  Marker 
Horizon  Line 
Angle-of-attack 
Pull  Up  Command 
Airspeed 

Altitude/Vert  Velocity 
Radar  Altitude  Advisory  Symbol 
Magnetic  Heading 
Plight  Director 
Landing  Director 

Terrain  Following  Pitch  Steering  Commands 
Drift  Angle 
Glide  Slope  Deviation 
Localizer  Deviation 

FLR 

5"  CRT  Sector  Display 
Adjustable  Cursor  for  NAV  Marks 

Projected  Map  Display 

5"  Projected  Slewable  Map  Sector  Display 

Present  Position 

Magnetic  Track  Angle 

Bearing  to  Destination 

Range  to  Destination 

Landmark  Update  Capability 
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The  accuracy,  the  resolution  and  the  data  rate  of  the 
inertially  derived  parameters  required  for  the  navigation  and  the 
weapon  delivery  computations  are  adequate  for  the  navigation 
displays. 

4.5  A-7D  Air  Data  Computations 

The  A-7D  air  data  computer  (ADC) ,  CP-953A/AJQ  uses  the 
sensed  static  pressure,  the  ram  pressure  and  the  free  air  tempera¬ 
ture  to  compute  the  true  air  speed,  the  indicated  air  speed,  the 
Mach  number  and  the  barometric  attitude. 

The  true  air  speed  is  used  with  the  inertially  derived 
velocity,  heading,  attitude  and  with  the  angle  of  attack  (AOA) 
from  the  AOA  transducer  in  computation  of  the  wind  velocity.  The 
computed  wind  velocity  is  stored  for  use  in  the  weapon  delivery 
computations,  in  the  degraded  navigation  modes  of  operation  and  it 
is  displayed  for  the  pilot. 

The  indicated  air  speed  is  used  for  the  pilot  head-up  dis¬ 
play  (HUD)  . 

The  Mach  number  is  used  in  the  weapon  delivery  computations 
and  in  the  automatic  flight  control  computations. 

The  barometric  altitude  is  used  primarily  to  stabilize  the 
vertical  channel  inertial  navigation  computations.  In  addition, 
the  barometric  altitude  is  used  in  computations  enployed  in  FLR 
(in  the  sweep  delay  correction  for  the  ground  map  use) ,  in  AFCS 
(in  attitude  hold  computations)  ,  in  IF^;^SIF  (in  altitude  reporting) 
and  in  AAU-19/A  altimeter  (in  pilot  readout) . 

Table  4-5  presents  a  list  of  the  ADC  derived  data  including 
the  range,  the  accuracy,  the  resolution  and  the  data  format  . 
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Table  4-5  Air  Data  Computer  Measurements 
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4. 6  C-5  INS  Navigation  Computations  Updating 

The  C-5  Kalman  Navigation/Alignment  Mechanization  is  shown 
in  functional  block  diagram  ,  Figure  4-1.  The  INS  computa¬ 

tions  are  updated  by  the  navigation  and  measurements  using  Kalman 
filter.  The  updating  provides  corrections  to  the  following  data; 

Position  (2) 

Velocity  (2) 

Altitude  Rate  (1) 

Altitude  (1) 

Computed  Heading  (1) 

Platform  Leveling  Rates  (2) 

Gyro  Biases  (3) 

Vertical  Accelerometer  (1) 

Doppler  Drift  Angle  (1) 

Ground  Speed  Scale  Factor  (1) 

Barometric  Altitude  (1) 


The  numbers  in  brackets  shown  above  indicate  the  number  of 
components  updated  by  the  Kalman  filter  computations. 

The  total  number  of  updated  variables  (state  variables)  is 
sixteen . 


ings 


The  following  navigation  aids  are  employed  in  the  updat- 
(19) 


1 .  Doppler  Radar 

2.  Loran  Receiver 

3.  Tacan  Receiver 

4.  Multimode  Radar 

5.  Position  Fix 

6.  Barometric  Altimeter 
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Figure  4-1.  C-5  Kalman  Navigation/Alignment  Mechanization, 

Functional  Block  Diagram (5) 


•  The  Doppler  radar,  manufactured  by  the  GPL  Division  of 
General  Precision  Systems,  Inc.,  supplies  the  conputer  with  mea¬ 
surements  of  ground  speed  and  drift  angle.  By  utilizing  the  in¬ 
formation  from  the  ball  readout,  it  is  possible  to  obtain  the 
ground  speed  relative  to  platform  axes. 

•  The  Loran  receiver  is  manufactured  by  Collins  Radio  Company. 
When  available,  Loran  data  is  converted  in  digital  computer  to 
provide  position  information  displayed  to  the  navigator.  Subject  to' 
the  navigator's  judgment  and  control,  the  Loran  data  can  also  be 
used  to  update  the  best  estimate  of  the  state  vector  which  in¬ 
cludes  position,  velocity,  and  other  quantities. 

•  The  Tacan  receivers,  manufactured  by  Hoffman  Electronics, 
provide  slant  range  and  bearing  information  to  ground  stations 

at  known  locations.  The  navigator  can  use  this  data,  when  avail¬ 
able,  in  a  manner  similar  to  that  described  for  the  Loran. 

•  The  multimode  radar  (MMR) ,  manufactured  by  Norden  Division 
of  United  Aircraft,  provides  many  modes  of  operation  for  the  C-5. 

Two  modes  are  used  to  obtain  navigation  information.  In  the 
terminal  phase  of  flight,  the  navigator  can,  through  a  cathode 

tube  display,  sight  on  landmark  patterns  whose  position  rela¬ 
tive  to  the  desired  supply  and/or  personnel  drop  location  is  known. 
Slant  range  and  bearing  data  is  provided  by  the  MMR  during  the 
terminal  phase.  The  navigator  can  also  use  the  MMR  for  sighting 
on  landmarks  whose  absolute  position  (latitude  and  longitude)  are 
known.  In  this  mode,  measurements  of  range,  bearing  and  landmark 
location  go  directly  to  the  Kalman  filter. 

•  Position  fix  data  are  available  from  Loran,  Tacan,  multimode 
radar,  visual  updates  and  celestial  fixes.  When  the  operator  re¬ 
quests  position  fix  data  from  Tacan,  for  exaple,  the  Tacan  routine 
processes  the  receiver's  slant-range  and  bearing  information  into 
craft  position.  Differences  between  the  system's  best  estimate  of 
craft  position  and  the  Tacan  determined  craft  position  are  computed 
and  displayed  to  the  operator  along  the  Tacan  determined  position 
and  a  suitable  radial  position  difference.  In  addition,  a  statis¬ 
tical  reasonableness  test  is  performed  on  each  of  the  Tacan  mea- 
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surements,  and  the  operator  is  informed  of  the  results.  If  the 
processor  finds  the  fix  to  be  reasonable,  the  operator  may  accept 
it  (FIX  ENABLE)  or  reject  it  (FIX  REJECT) .  If  the  processor  finds 
the  fix  to  be  unreasonable,  the  operator  may  reject  it  or  over¬ 
ride  it  (FIX  OVERRIDE)  .  This  same  procedure  is  followed  when  the 
operator  requests  data  from  the  Loran,  multimode  radar,  visual 
fixes  or  celestial  fixes. 

•  The  barometric  altimeter  is  a  part  of  the  two  air  data  com¬ 
puter  (CADC)  manufactured  by  Elliot  Brothers.  The  barometric 
pressure  altitude  data  is  used  in  the  navigational  computations. 

•  Kalman  filter  computations  are  mechanized  on  NDC-1051A 
digital  computer,  manufactured  by  Northrop  Electronics  Division, 
The  sampling  rate  of  the  navigation  aids  measurements  is  of  the 
order  of  one  sample  per  second  and  a  typical  Kalman  computation 
updating  cycle  is  of  the  order  of  a  few  minutes.  The  measurements 
samples  are  averaged  over  the  Kalman  computation  cycle.  The  com¬ 
putations  employ  floating-point  arithmetic  utilizing  28— bit  word 
shared  equally  by  mantissa  and  exponent  with  2200-words  alloca¬ 
tion. 

The  range  and  accuracy  of  typical  navigation  aids  measure¬ 
ments  employed  in  the  aircraft  navigation  (not  necessarily  in  C-5) 

^  .  rn  1.1  yi  i:(20)  (21) 

are  shown  in  Table  4-6 
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Table  4-6  Typical  Characteristics  of  Navigation 
Aids  Measurements 


INS 

TYPE 

AVIONIC 

SYSTEM 

TYPE 

AVIONIC 

SYSTEM 

DERIVED 

DATA 

INERTIAL 

SYSTEM 

NAVIGATION 

APPLICATION 

TYPICAL  NAV-AIDS 
MEASUREMENTS 
CHARACTERISTICS 

REFERENCE 

RANGE 

ACCURACY  (Iff) 

AN  AIDED 
INS 
(C-5) 

DOPPLER 

RADAR 

DRIFT 

ANGLE 

30  DEG 

0.1  DEG 

GROUND 

SPEED 

100  TO 

1000 

KNOTS 

0.1%  + 

0.1  KNOT 

20 

LORAN  C 
RECEIVER 

LORAN  D 
RECEIVER 

AIRCRAFT 

POSITION 

KALMAN  FILTER 

COMPUTATION  OF  CORRECTIONS 

LISTED  IN  SECTION  4.6 

MAJOR 

SHIPPING 

LANES 

350  FT 

21 

TACAN 

RECEIVER 

SLANT  RANGE 
TO  TACAN 
STATION 

300n 

MILES 

600  FT 

BEARING  TO 
TACAN 

STATION 

1  DEG 

MULTI 

MODE 

RADAR 

SLANT  RANGE 

TO  KNOWN 

POINT 

BEARING  TO 
KNOWN  POINT 

POSITION 

FIX 

LATITUDE 

LONGITUDE 

BARO¬ 

METRIC 

ALTIMETER 

BAROMETRIC 

ALTITUDE 

-1000 

TO 

50,000  FT 

5  FT  OR  0.05% 

OF  ALTITUDE 

20 
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4.7  SAR  Antenna  Motion  Compensation 

The  Synthetic  Aperture  Radar  (SAR) ,  used  for  mapping  to  the 
side  of  the  aircraft,  is  a  part  of  the  Electronically  Agile  Radar 
(EAR) .  The  required  mapping  azimuth  resolution  is  obtained  in 
SAR  mapping  by  generation  of  an  effective  long  antenna  derived 
from  signal  processing  means  rather  than  from  the  actual  use  of  a 
long  physical  antenna.  In  SAR  a  radiating  element,  translated  with 
the  aircraft,  assumes  sequential  positions  along  a  line.  At  each 
of  these  positions  a  signal  is  transmitted  and  the  amplitude  and 
phase  of  the  radar  signals  reflected  from  the  terrain  are  stored. 
After  the  radiating  element  transversed  a  predetermined  distance, 
equal  to  the  effective  length  of  the  antenna,  the  stored  signals 
resemble  strongly  the  signals  that  would  have  been  received  by 
the  elements  of  an  actual  linear  array  with  the  same  effective 
antenna  length.  Consequently,  the  effect  of  a  long  physical 
linear  antenna  array  is  achieved  by  a  single  moving  radiating 
element. 

An  uncompensated  motion  of  the  SAR  antenna  during  the  map¬ 
ping  time  interval  is  introducing  phase  errors  in  the  stored 
radar  signals.  The  resultant  range  errors  are  directly  propor¬ 
tional  to  the  phase  errors. 

The  SAR  antenna  motion  may  be  sensed  by  an  IMU,  hard- 
mounted  on  the  antenna.  Two  possible  IMU  configurations  employed 
for  the  antenna  motion  compensation  are  as  follows : 

1.  A  high  quality  master  IMU  mounted  directly  on  the 
antenna. 

2.  A  less  accurate,  slave  IMU  mounted  on  the  antenna  and 
a  high  quality  master  IMU  moiinted  approximately  1  meter 
away. 

The  antenna-mounted  IMU  performance  required  for  the  SAR 
antenna  motion  compensation  is  listed  in  Table  4-7. 
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Table  4-7  IMU  Data  Requirements  for  EAR  Antenna  Motion  Compensation 


The  listed  accuracy,  resolution  and  rate  of  the  inertial 
data  is  required  to  meet  the  present  design  criteria  for  the 
SAR  the  assimptions  used  in  developing  this  specification 

are: 

1.  The  IMU  is  hard  mounted  to  the  antenna  and  the  antenna 
is  hard  mounted  to  the  aircraft. 

2.  B-1  aircraft  environment  with  a  2  g  maneuver  and  angu¬ 
lar  rates  of  20  deg/sec. 

3.  Mapping  range  50  n  miles,  the  antenna  squint  angle  20 
deg,  the  aircraft  velocity  600  ft/sec. 

4.  Hamming  weighting  the  Peak  Side  Lobe  Ratio  (PSLR)  is 
below  -30dB,  the  Strehl  intensity  is  larger  than  0.8  and  the 
flare  ratio  (used  in  specif cation  of  the  average  clutter)  is 

0.1. 
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SECTION  5 


SELECTION  OF  COMPUTATIONAL  FRAME 
FOR  THE 

COMPUTER  ERRORS  SIMULATION  PROGRAM 


The  INS  navigation  computations  may  be  performed  in  either 
the  local-level  or  the  space-stabilized  frame. 

The  criteria  used  in  the  selection  of  the  computational 
frame  for  the  computer  errors  simulation  program  are  as  follows: 

1.  World-Wide  navigation  computations  capability. 

2.  Maximum  commonality  in  the  navigation  computations  for 
the  INS  with  a  local-level  stabilized  platform,  a  space- 
stabilized  platform  and  a  strapdown  configuration. 

3.  Minimum  of  required  computer  complexity. 

4.  Simple  interface  with  the  avionic  systems'  computations 
including  the  computations  used  for  the  flight  control, 
weapon  delivery,  and  the  radar  antenna  motion  compensation. 
Simple  interface  with  the  navigation  aid  measurements  data. 

The  local-level,  geodetic  wander-azimuth  frame  was  selected 
as  a  computational  frame  for  the  INS  computer  errors  simulation 
program.  The  frame  selection  was  dictated  primarily  by  the  sim¬ 
pler  computation  format  for  the  INS  with  a  local-level  stabilized 
platform  and  simpler  software  interfaces  with  most  avionics  compu¬ 
tations  and  navigation-aid  measurements.  Computations  in  the 
space-stabilized  frame  are,  however,  somewhat  simpler  for  the 
space-stabilized  and  strapdown  INS. 

Comparison  of  the  local-level  and  the  space-stabilized  com- 
putational  frames  characteristics  is  suinmarized  in  Table  5-1. 
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Table  5-1.  Con^arison  of  Local-Level  and  Space-Stabilized 

Computational  Frames 


COMPUTATIONAL  FRAME  CHARACTERISTICS 

SELECTION  CRITERIA 

LOCAL-LEVEL 

SPACE-STABILIZED 

World-Wide 

Navigation 

Requires  Wander- 
Azimuth,  Free-Azi- 
muth,  Unipolar,  or 
Inverse  Coordinates 

No  Added  Requirements 

Commonality  of  Coirputations 

Required  Additional 
Transformations  in 
Attitude  Coitputations 
for  Space-Stabilized 
and  Strapdown  INS 

See  Additional  Trans¬ 
formations  Required 

Complexity  of  Computations 

Simpler  Computations 
for  Local -Level  INS 

Simpler  Computations 
for  Space-Stabilized 
and  Strapdown  INS 

Interface  with  Other  Avionic 
Computations 

Siirpler  Interface 
with  Most  Avionics 
and  Navigation  Aids 
Computations 

Siitpler  Interface  with 
Some  (Star  Tracker) 
Navigation  Aids  Compu¬ 
tations 

The  remaining  part  of  this  section  contains  a  discussion  of 
the  frame  selection  criteria  listed  above. 


i*  World-Wide  Navigation  Capability.  Near  the  earth's 
poles,  latitude-longitude  are  poor  navigation  coordinates 
because  of  the  convergence  of  meridians.  This  effect  re¬ 
sults  in  both  mechanical  and  computational  difficulties  in 
the  implementation  of  the  local-level  platform  stabiliza¬ 
tion.  For  the  INS  with  the  north-pointing  platform  stabi¬ 
lization  operating  near  the  polar  region,  the  required 
azimuth  gyro  torquing  rate  becomes  excessive  and  the  compu¬ 
tation  of  certain  latitude  functions  and  longitude  rate  have 
singularities  at  the  poles. 

These  difficulties  could  be  removed  by  the  use  of  modified 
local-level  coordinates  for  the  platform  stabilization  frame 
and  for  the  navigation  con^jutational  frame.  Various  modi¬ 
fied  local-level  frames  employ  the  wander-azimuth,  the  free- 
azimuth,  the  unipoloar,  and  the  inverse  coordinates. 
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Ths  navigation  computations  in  ths  wandejr“azimuth  £cam@/ 
selected  for  this  simulation  program,  determine  the  INS 
position  and  velocity  in  the  latitude-longitude  coordinates. 
While  the  wander-azimuth  frame  computations  eliminate  the 
problems  encountered  in  the  computations  utilizing  the  local- 
level  north-pointing  frame,  the  use  of  latitude-longitude 
coordinates  for  the  polar  region  navigation  is  not  the  best 
choice . 

The  navigation  computations  in  the  space-stabilized  frame 
determine  the  INS  position  and  velocity  in  the  space-stabi¬ 
lized  coordinates.  The  computed  position  and  velocity  can 
be  then  resolved  in  any  desired  frame  (for  example  along  the 
track,  cross  track  and  altitude  directions) . 

2.  Maximum  Commonality  of  the  Navigation  Computations.  The 
commonality  of  computations  for  both  computational  frames 
starts  from  processing  of  the  velocity  increments  sensed  by 
the  accelerometers  and  resolved  in  the  computational  frame 
axes  and  ends  with  the  computed  position  and  velocity  re¬ 
solved  in  the  desired  coordinates,  as  shown  in  Figures  3-3 
and  3-7. 

The  aircraft  attitude  computations  have  the  same  format  for 
either  of  the  computational  frames,  as  shown  in  Figures  3-11, 
3-12,  and  3-13.  However,  for  the  computations  in  the  local- 
level  wander— azimuth  computational  frame ,  additional  trans¬ 
formations  are  required  for  either  the  space  stable  or  the 
strapdown  INS  due  to  the  absence  of  the  inertial  frame  and 
the  inclusion  of  the  wander  angle. 

3.  Minimum  of  Required  Computer  Complexity.  For  the  INS 
with  a  local-level  stabilized  platform  the  navigation  com¬ 
putations  in  the  local— level  frames  are  somewhat  simpler 
than  the  navigation  computations  in  the  space-stabilized 
frame . 
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For  the  INS  with  a  space-stabilized  platform  and  for  the 
strapdown  INS,  the  navigation  computations  in  the  space- 
stabilized  frame  are  considerably  simpler  than  the  naviga¬ 
tion  computations  in  the  local-level  frame . 

Simpler  Interface  with  the  Avionic  System  Computations 
and  witdi  ths'  Navigation  Aids  Measurenents .  The  navigation 
computations  in  the  local— level  wander— azimuth  frame  have 
somewhat  siiipler  interface  with  some  avionic  system  computa¬ 
tions  and  with  the  navigation  aids  measurements  than  the 
navigation  computations  in  the  space-stabilized  frame. 
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6.0  SELECTION  OF  STANDARDIZED  FRAMES  SYMBOLOGY. 


6.1  INTRODUCTION 

This  section  presents  a  proposed  standardized  symbology  of 
the  coordinate  frames  and  the  frames  transformations  employed 
during  the  INS  navigation  computations.  It  is  recognized  that 
the  proposed  standardization  is  somewhat  arbitrary  and  incom¬ 
plete,  but  it  represents  a  reasonable  simple  and  consistent 
sets  of  symbols  and  definitions  of  frame  axes  orientations.  The 
proposed  coordinate  frames  symbology  is  based  on  terminology 
employed  by  Honeywell  in  GEANS  studies  '  and  the  proposed  trans¬ 
formation  frames  symbology  is  based  on  Britt ing  notation .  A 
tutorial  discussion  of  transformation  of  coordinates,  described 
in  Appendix  A,  is  used  as  a  background  for  the  material  pre¬ 
sented  in  this  section. 

6.2  PROPOSED  SYMBOLOGY  STANDARDIZATION 

1.  A  right-handed,  orthogonal,  cartesian  coordinate  frame, 

i,  is  defined  by  specifying  three  orthogonal  unit 

vectors  along  the  frame  axes. 

2.  A  vector  A  expressed  in  the  frame  i,  is  designated  by  A^. 

The  components  of  the  A  vector  in  the  i  frame  are 

designated  by  A  ,  A  ,  A  . 

^i  ^i  ^i 

3.  A  vector  B  representing  a  motion  of  the  frame  i  with 

respect  to  the  frame  j  and  expressed  in  the  frame  k  is 
designated  by  B .  .. 

4 .  A  coordinate  transformation  from  the  frame  i  to  the  frame 

j,  having  a  common  origin,  is  represented  by  angles  of 
rotation  about  at  most  the  three  i  frame  exes  required 
to  bring  the  frame  i  axes  to  coincide  with  the  corres¬ 
ponding  frame  j  axes. 

For  example  the  following  rotations  may  be  required  to  bring 
the  frame  i  axes  into  coincidence  with  the  frame  j  axes: 
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a.  A  rotation  about  the  eixls  through  an  angle  a. 

b.  A  rotation  about  the  axis  (displaced  by  the  previous 

rotation)  through  an  angle  g. 

c.  A  rotation  about  the  axis  (displaced  by  the  previous 
two  rotations)  through  an  angle  y. 

The  angles  a,  g,  y  are  called  the  Euler  angles.  The  positive 
sign  of  the  rotation  angles  is  defined  by  a  right-hand  rule. 

An  example  of  a  positive  rotation  by  an  angle  a  about  the  x.  axis 
is  shown  in  Figures  6-1  and  6-2. 

The  rotation  angles  are  usually  expressed  by  a  direction 
cosine  matrix  (9  terms)  or  a  quaternion  (4  terms).  The  coordin¬ 
ate  transformation  from  the  frame  i  to  the  frame  j  expressed 
by  a  direction  cosine  matrix  is  designated  by  and  expressed  by  a 
quaternion  is  designated  by  q?. 

5.  The  major  coordinate  frames  used  in  the  INS  navigation 
computations  are  shown  in  Figures  6-3,  6-4  and  they 
are  listed  in  Table  6-1. 

6.  A  general  circle  diagram  representing  the  coordinate 
frames  transformations  used  in  the  navigation  computations 
of  a  local-level,  a  space-stabilized  and  a  strapdown  INS 

is  shown  in  Figure  6-5.  The  transformations  are  also  listed 
in  Table  6-2. 


Figure  6-1.  Rotation  About  X-axis,  Vector  Representation 
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0 — i  KD  ^  © 

"from"  axis  of  "to" 

frame  rotation  frame 


Figure  6-2.  Rotation  About  X-axis,  Circle  Diagram  Representation 


Figure  6-3.  Frames  Used  in  SPN/GEMIS  Computations 
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Figure  6-4.  Vehicle  Frame  Axes  Used  in  SPN/GEANS 
Computations 
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Table  6-1.  Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA  Systems  with  SS 
or  LVWA  Navigation 


0— frame 

THE  INERTIAL  REFERENCE  FRAME 

defined  at  moment  of  entry  into  navigation  i.e.  at  t  =  0. 

0'-”frame 

THE  EARTH  FIXED  FRAME 
coincides  with  0— frame  at  t  =  0. 

2— frame 

THE  LOCAL  VERTICAL  NORTH  FRAME 
is  the  frame  of  the  position  and  velocity  outputs. 

2'-frame 

THE  LOCAL  VERTICAL  WANDER  AZIMUTH  FRAME 
■  coincides  with  stable  element  of  LVWA  platform  and 
generally  with  2— frame  at  t  =  0. 

5— frame 

THE  BODY  OR  STRAPDOWN  PLATFORM  FRAME 
defined  by  lateral  and  longitudinal  axes  of  the  vehicle. 

10— frame 

THE  SPACE  STABLE  PLATFORM  FRAME 
coincides  with  stable  element  of  SS  platform 
(any  orientation). 
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APPENDIX  A 

TRANSFORMATION  OF  COORDINATES 


A.l  Introduction 

A  simple,  compact,  unambiguous  notation  describing  trans¬ 
formation  from  one  orthogonal  axis  frame  to  another  is  pre¬ 
sented  in  this  section. 

The  notation  used  in  describing  the  vectors  and  the  coordin- 

• '  •  (15) 

ates  transformations  is  based  on  notation  used  by  Britting 
and  the  definition  of  axes  frames  is  based  on  Honeywell  conven¬ 
tions  used  in  SPN/GEANS^^\  The  definitions  and  the  notations 
presented  in  this  Appendix  form  a  base  for  the  proposed  symbology 
of  frames  and  transformations  described  in  Section  6. 


A. 2  Single  Axis  Rotations 

A  coordinate  frame,  i,  is  defined  by  specifying  three 

^ 

orthogonal  unit  vectors  Yj^,  Z^,  which  form  a  right  handed 
system,  i.e.. 


/V  /V  /V 


X  Y.  =  Z. , 

^i 

X  Z. 

=  X., 

^i 

X  X. 

/V  A 

X.  •  Y.  =  0, 

A, 

^i 

A 

•  "i 

=  0, 

A 

"i 

A 

•  ^i 

where  "x"  denotes  the  vector  product  and  the  scalar  product 
of  two  vectors. 

The  "i"  is  the  short  hand  name  of  the  frame  and  is  one 
or  more  numbers  or  letters  or  some  combination  thereof.  The 
practice  of  referring  to  the  unit  vectors  defining  a  frame  as 
i,  j,  k;  u,  V,  w?  M,  N,  0;  X,  Y,  Z;  etc.  will  not  be  used  be¬ 
cause  there  are  too  many  frames  and  one  would  soon  run  out 
of  triples  of  letters  for  which  the  sequence  is  obvious.  Further, 
the  existence  of  an  x-axis,  a  y-axis,  and  a  z-axis  in  each 
frame  is  indispensable  to  the  concept  of  single  axis  rotations. 
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Consider  two  Cartesian  coordinate  frames  with  a  common 
origin.  Denote  the  first  frame  by  i  and  the  second  by  j.  Then 

A  A  A  ys 

toe  unit  vectors  defining  the  two  frames  are  X^,  Z^,  and  Xj,Y^ 

Z j .  If  one  axis  of  one  frame  coincides  with  the  corresponding 
axis  of  the  other  frame,  i.e.,  if 

A  A  A  A  A  A 

Xf  =  Xj  or  =  Yj  or  Z^  =  Z j ,  then  the  transformation 
from  one  frame  to  the  other  is  at  most  a  single  axis  rotation.' 

The  axis  which  is  common  to  the  two  frames  is  the  axis  of  rota¬ 
tion  and  the  angle  between  the  corresponding  non-common  axes 
is  the  angle  of  rotation  or  argument.  The  sign  of  the  angle 
of  rotation  is  positive  if  the  non-common  axes  of  the  first 
("from")  frame  move  in  a  clockwise  direction  to  bring  them¬ 
selves  into  coincidence  with  the  corresponding  axes  of  the 
second  ("to")  frame,  looking  in  the  positive  direction  along 
the  common  axis  (right  hand  screw  rule) . 

X-axis  Rotation,  X  (ot) 

A  A 

If  X.  =  X . ,  the  transformation  is  an  x-axis  rotation; 

J  A  .  A  A  A 

and  if  the  angle  between  and  Y ^ ,  and  Z^  and  Z^,  is  a  and  if  a 
is  positive,  then  transformation  from  i  to  j  is  written  as  X(a). 
This  is  illustrated  in  Figure  A-1. 

The  equations  relating  the  unit  vectors  of  the  j 
frame  axes  to  the  unit  vectors  of  the  i  frame  axes  are: 


A  A 


A 

=  ^i 

A 

A 

Y. 

=  COS  a  Y.  +  sin  a 

z. 

D 

1 

A 

A 

z . 

3 

=  -sin  a  Y^  +  cos  a 

Zi 

or  in  matrix  form 
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Figure  A-1.  Rotation  About  X-axis 

In  this  particular  case,  the  rotation  from  i  to  j ,  denoted  by 
is  :X(a)  .  It  is  often  helpful  to  represent  a  number  of 
single  axis  rotations  in  a  signal  flow  graph  form  as  shown 
in  Figure  A- 2. 


G) — i — *©  -  — O 

"from"  axis  of  "to" 

frame  rotation  frame 


Figure  A-2.  Rotation  About  X-axis  Flow  Diagram 
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The  arrowhead  indicates  the  "to"  frame.  Changing  the 
direction  of  the  arrow  corresponds  to  changing  the  sign  of  the 
argument  or  transposing  the  rotation  matrix. 

Y-axis  Rotation/  Y(B) 

A  A 

Simlarly,  if  Y^  =  Yj^,  the  transformation  from  the  j 
frame  to  the  k  frame  is  a  Y-axis  rotation.  For  a  positive 
argument,  3,  this  is  written  as  Y(e)  and  is  illustrated  in 
Figure  a-3. 


Figure  Ar3.  Rotation  about  Y-axis 
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k 

In  signal  flow  form  we  have  for  Cj  (Figure  A-4) 


Figure  a-4.  Rotation  About  Y-axis  Flow  Diagram 

Z - axi s  Rotation ,  Z ( y ) 

/N  /V 

Finally,  if  Zj^  =  Z^,  the  transformation  from  the  k 
frame  to  the  I  frame,  C^r  for  a  positive  argument,  y,  is 

written  as  Z (y)  and  is  illustrated  in  Figure  A-5. 


Figure  A-5.  Rotation  About  Z-axis 


In  signal  flow  form  we  have  for 


Figure  A-6.  Rotation  about  Z-axis  Flow  Diagram 


A.  3  The  General  Rotation 

If  the  three  single  axis  rotations  are  cascaded,  the 
transformation  from  the  i  frame  to  the  I  frame,  C^,  may  be 
written  as 


=  Z(y)  Y(e)  X(a) 

Note,  that  the  subscripts  cancel  the  superscripts 
from  lower  left  to  upper  right,  leaving  only  the  lower  right 
subscript  ("from")  and  the  upper  left  superscript  ("to") . 
This  latter  notation  appears  in  Britting .  The  vector 
is  designated  by  a  small  letter  with  one  or  more  sii)- 
scripts,  if  required.  The  frame  in  which  a  vector  is 
defined  is  denoted  by  a  superscript  and  transforming  a 
vector  V  from  the  i  frame  to  the  Si  frame  is  expressed  as 
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For  a  vector  with  notation  employing  two  subscripts,  such  as  the 

til  t  ll 

angular  velocity  of  the  i^  frame  with  respect  to  the  j  frame, 

th  k 

expressed  in  the  k  frame  is  expressed  by  o) .  .  . 

~j  1 1 

£ 

The  transformation,  or  any  other  sequence  of  three 
successive  rotations  wherein  the  axis  of  the  middle  rotation 
is  different  from  the  axes  of  rotation  on  the  outside,  is  often 
loosely  referred  to  as  the  Eulerian  angle  method  of  specifying 
the  transformation  relating  any  two  Cartesian  coordinate  frames 
with  common  origin  —  i.e.,  the  Euler  angle  method  permits  the 
specifying  the  transformation  from  one  orthogonal  frairoe  to 
another  by  stating  the  sign  and  magnitude  of  the  three  angles 
but  implies  a  particular  order  of  the  axes  of  the  successive 
rotations,  generally  X,  Y,  Z. 

Several  of  these  general  rotation  matrices  occur  in  the 
mechanization  of  navigation  equations  for  the  various  types  of 
INS.  Two  examples  of  frame  transformations  employed  in  the  navi¬ 
gation  computations  of  the  INS  with  the  local— vertical  wander- 
azimuth  (LVWA)  and  with  the  space-stabilized  (SS)  platform  are 
shown  in  Figures  A-7  and  A-8,  In  either  case,  four  transforma¬ 
tions  are  required  if  attitude  is  computed.  Two  of  the  frames 
indicated,  the  local— vertical  north  frame  and  the  body  frame, 
are  common  to  both  the  LVWA  and  the  SS  systems  (and  also  the 
strapdown  system) .  The  number  of  single  axis  rotations  repre¬ 
sented  by  each  of  the  transformations  shown  varies  from  one  to 
four  or  more. 

A  prerequisite  to  establishing  a  simple,  consistent  set 
of  single  axis  rotations  relating  the  frames  of  interest  is  to 
define  the  coordinate  axes  of  one  frame  and  then  relate  the 
others  to  it  via  the  appropriate  rotations. 


EARTH 

FIXED 


Figure  A-7.  Transformation  Required  for  Local  Vertical  Wander-Azimuth 
INS  Navigation  Computations  in  LVWA  Computational  Frame 


Figure  A -8.  Transformation  Required  for  Space  Stable  INS  Computat 
in  SS  Computational  Frame 


For  simplicity,  it  is  desirable  to  avoid  the  introduction  of 
rotations  of  ir  or  +‘ir/2  which  are  added  to  the  nominal  angles 
of  rotation.  This  enables  one  to  state  that  if  all  the  angles 
relating  one  frame  to  another  are  zero,  the  corresponding 
axes  of  both  frames  coincide. 

Since  the  choice  of  the  frame  to  be  defined  as  the  start¬ 
ing  frame  is  arbitrary  it  might  as  well  provide  some  useful 
simplification.  The  one  chosen  in  this  discussion  simplifies 
the  initialization  of  a  space  stable  system. 

A. 4  General  Circle  Diagram 

A.4.1  Introduction 

A  general  circle  diagram  ^  ,  presenting  the  coordinate 

transformations  among  frames  used  in  the  ins  navigational 
computations  is  shown  in  Figure  A-9  and  the  angles  of  rotation 
iisted  in  Table  A-l.  Definition  of  the  coordinates'  frames 
is  based  on  Honeywell  conventions  used  in  SPN/GEANS  ^  and  shown 
in  Figures  A- 10  and  A-11. 

The  general  circle  diagram.  Figure  A— 9,  was'  obtained  by 
superimposing  the  flow  graphs  of  Figures  A-7  and  A- 8  for  the 
LVWA  and  SS  systems  and  replacing  the  matrices  in  the  rectangular 
boxes  by  appropriate  sequences  of  single  axis  rotations.  Each 
the  four  reference  frames  fundamental  to  navigation  and 
attitude  computation  for  the  LVWA  and  SS  systems  is  indicated 
and  named  within  the  rectangular  box  adjacent  to  the  small 
circle  (node)  designating  the  particular  frame.  The  total  of 
six  fundamental  frames  of  interest  tabulated  in  Table  A-2 
include  not  only  the  SS  and  LVWA  systems  but  also  the  strap- 
down  (SD)  system.  (In  the  latter  case,  it  is  assumed  that  the 
axes  of  the  strapdown  system  coincide  with  the  corresponding 
axes  of  the  body  or  vehicle  frame.) 
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y 


LOCAL  LEVEL 

WANDER 

AZIMUTH 


Table  A-1.  Definition  of  Angles  in  General  Circle  Diagram 


^ie^  - 

Earth's  rate  times  time  (from  t  = 

0) 

positive  to  East 

X 

Change  in  longitude  (from  t  =  0) 

positive  to  East 

L 

Geodetic  latitude 

Heading  (true) 

positive  to  East  from  North 

d 

Pitch  (true) 

positive  for  nose  up 

'P 

Roll  (true) 

positive  for  right  wing  down 

a  — 

Wander  angle 

positive  to  East  from  North 

- 

LVWA  yaw 

positive  CW  about  down  (same  as  ipl 

V^LI  - 

LVWA  inner  roll 

(nominally  zero)  (same  as  ^p) 

0L  - 

LVWA  pitch 

positive  for  nose  up  (same  as  0) 

•^LO  - 

LVWA  outer  roll 

positive  for  right  wing  down  (same  as  p) 

04  - 

SS  gimbal  #4 

J  positive  for  CW 

03 

SS  gimbal  #3 

>  rotation  of 

$2 

SS  igmbal  #2  (nominally  zero) 

1  inner  gimbal 

01  - 

SS  gimbal#! 

w.r.t.  outer  gimbal 

®x  - 

^  - 
0 

z 

SS  J 

I  Euler  angles  implicit  in  alignment 

SS  >  matrix. 

1  Assumed  constant  in  this  study. 

SS  1 

Euler  angles  for  Strapdown  alignment  matrix  not  shown  since  they  are  not  found  explicitly. 


Table  A-2.  Coordinate  Frames  of  Interest  for  SS,  SD,  and  LVWA  Systems  with  SS 
or  LVWA  Navigation 


The  six  coordinate  frames  of  interest  for  any  of  the  six  cases  indicated  are: 

0  —frame 

THE  INERTIAL  REFERENCE  FRAME 

defined  at  moment  of  entry  into  navigation  i.e.  at  t  =  0. 

0'  —frame 

THE  EARTH  FIXED  FRAME 
coincides  with  0— frame  at  t  =  0. 

2— frame 

THE  LOCAL  VERTICAL  NORTH  FRAME 
is  the  frame  of  the  position  and  velocity  outputs. 

2'— frame 

THE  LOCAL  VERTICAL  WANDER  AZIMUTH  FRAME 
coincides  with  stable  element  of  LVWA  platform  and 
generally  with  2— frame  at  t=  0. 

5— frame 

THE  BODY  OR  STRAPDOWN  PLATFORM  FRAME 
defined  by  lateral  and  longitudinal  axes  of  the  vehicle. 

10— frame 

THE  SPACE  STABLE  PLATFORM  FRAME 
coincides  with  stable  element  of  SS  platform. 
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Figure  A-10.  Coordinate  Frames  Used  in  SPN/GEANS 

Computations 
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Figure  A- 11.  Vehicle  Frame  Axes  Used  in 
SPN/GEANS  Computations 
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Each  individual  node  (result  of  a  single  axis  rotation) 
is  specified  by  a  .numeral,  starting  with  O(zero)  for  the 
inertial  reference  frame.  Closely  related  frames  may  be  desig¬ 
nated  by  the  same  numeral  with  varying  numbers  of  superscripted 
primes  ( ' ) . 


A. 4. 2  Inertial  Reference  Frame 

The  definition  of  the  inertial  reference  frame  is  illus¬ 
trated  in  Figure A-10..  Under  these  definitions,  the  transforma¬ 
tions  from  the  local  vertical  north  frame  ,2,  to  the 
inertial  frame  at  t  =  0  is  simply  Y(L) ,  where  L  is  the  geodetic 
latitude  of  the  INS  navigation  position,  is  the  change  in 
longitude  from  the  initial  longitude. 

A. 4. 3  The  Space  Stable  "Position"  Matrix,  C^,  or  Inertial 
to  Local  Vertical  North  Transformation 

This  transformation  represented  by  the  first  three 
single  axis  rotations  proceeding  counterclockwise  from  the 
inertial  frame,  0,  (Figure  A-9)  is  shown  in  Figure  A-12. 


Figure  A-12.  Inertial-to-Local  Vertical  Transformation 
It  is  written  as 

Cq  =  Y  (-L)  Z(A)  Z(a)^gt) 

=  Y  (-L)  Z(A+a)^gt) 


cosL  cos 

A 

cosL  sin 

A 

sinL 

-sin  A 

cos  A 

0 

-sinL  cos 

A 

-sinL  sin 

A 

cosL 
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where  A  =  X  +  is  the  change  in  celestial  longitude  from 

t  =  0  and  is  given  by 

A  =  ta„-l(x) 

where  X  and  Y  are  the  equatorial  components  of  inertial 
position. 

The  geodetic  latitude, l  is  computed  from 


L  =  tan 

g 


where  Z  is  the  polar  component  of  inertial  position  and  e  is 
the  eccentricity  of  the  meridional  ellipse. 


For  output,  the  geodetic  longitude,  X is  computed  from 

y 

X  =  X_  +  A  -  (0.  t 
g  go  le  , 


where  X^^  is  the  longitude  east  of  Greenwich  at  t  =  0 . 


2 

In  the  space  stabilized  navigation  computations,  Cq 
is  employed  in  the  transformation  of  inertial  velocity  to  the 
local  vertical  north  (LVN)  frame,  in  the  attitude  computations 
and,  in  aided  systems,  in  the  application  of  velocity  damping 
and  position  reset  calculations. 

2 

A. 4 . 4  The  Attitude  Matrix,  C^,  or  Body  to  Local  Vertical 

North  Transformation 

The  transpose  of  this  transformation,  C^,  may  be  repre¬ 
sented  by  the  three  single  axis  rotations  proceeding  from  the 
terminus  of  the  preceding  transformation  (the  LVN  frame  or  2- 
frame)  to  the  body  frame  or  5-frame.  Alternate  methods  of 
representing  the  same  transformations  follow  the  more 
complex' routes  through  the  space  stable  platform  frame  ,0, 
or  the  local  vertical  wander  azimuth  frame,  2,.  A  third 
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alternate  representation  of  the  attitude  matrix  is  indicated 
as  embodying  the  (strapdown)  body  to  inertial  frame  trans¬ 
formation  and  the  "position"  matrix.  All  routes  between  two 
nodes  must  yield  the  same  transformation.  In  the  signal  flow 
form  of  Figure  A-9,  is  shown  in  Figure  A-13 . 

GHKD-HD-Ki) 


Figure  A-13.  Body  to  Local  Vertical  Transformations 
It  is  written  as 

C2  =  z(<l>)  Y(e)  x(-ip) 

The  attitude  angles,  (j),  0,  ip,  correspond  to  the  gimbal 
angles  of  a  perfect,  local  geodetic  vertical,  north-slaved, 
three  gimbal  platform,  with  a  gimbal  order  of  azimuth  (up) , 
pitch  (right) ,  roll  (forward) .  Changes  in  the  attitude 
angles  are  all  positive  as  the  vehicle  goes  from  straight  and 
level  flight  into  a  climbing  right  hand  turn.  From  the 
circle  diagram.  Figure  A-9,  all  the  attitude  angles  are  zero 
when  the  vehicle  is  level  and  heading  north.  The  attitude 
matrix  is  given  by 

A 

C^=X(ip)  Y(-0)  z{-«J>)  =  [a..] 

5  13 

I  -COS0  sin(J) 

cosi|/  sin<f>  -sini>  sinO  cos<()  I  cos^  cos<t>  +sin^  sin0  sin<J) 
sinij)  sincj)  -cosip  sin0  coscf)  1  -sini/;  coscj)  +cosiij  sin0  sincf) 


j  sin0 
I  sini/;  COS0 
j  COSlp  COS0 
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and  the  attitude  angles  are: 


The  axes  of  rotation  are  permuted  whenever  the  defini¬ 
tion  of  the  inertial  and  hence  the  LVN  frame  is  changed;  how¬ 
ever,  all  attitude  matrices  based  on  the  same  definition  of 
the  attitude  angles  are  related  by  similarity  transformations. 

The  attitude  matrix  must  be  computed  for  a  space  stable 
system,  and  may  be  computed  as  part  of  the  high  speed  computa¬ 
tions  for  a  north-slaved,  geodetic  vertical  strapdown  system. 
The  three  gimbal,  horth-slaved ,  geodetic  vertical  system  pro¬ 
vides  attitude  directly.  A  four  gimbal,  LVWA  system — in  a 
high  performance  aircraft,  where  the  inner  roll  angle, 
is  not  always  zero  must  also  compute  the  attitude  matrix. 

A. 4. 5  The  LVWA  "Direction  Cosine  "Matrix,  C^,  or  LVWA 
Platform  to  Earth  Fixed  Transformation 

The  “direction  cosine"  matrix  for  the  local  vertical 

wander  azimuth  (LVWA)  system  is  the  transformation  from  the 

0 ' 

LVWA  frame,  2',  to  the  earth  fixed  frame.  O',  C2, -  Of 
course,  any  rotation  is  a  direction  cosine  matrix  but  only 
the  one  matrix  (and  most  of  its  elements  individually)  appear 
explicitly  in  most  mechanizations  of  LVWA  systems. 
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In  terras  of  the  noraenclature  of  Figure  A-9,  the  LVWA 
platform  to  the  earth  fixed  frame  transformation,  C^i 
is  shown  in  signal  flow  form  in  Figure  A-14. 


Figure  A-14.  LVWA  to  Earth  Fixed  Frame  Transformation 


It  is  written  as; 


c°|=  Z(-A)  Y(L)  X(a)=  [A.J 


cosX  cosL 
~  sinX  COS.L 
sinL 


cosX  sinL  sina  — sinX  cosa 
sinX  sinL  sinoi  +cosX  cosct 
“CosL  sina 


“CosX  sinL  cosa  ~sinX 
-sinX  sinL  cosa  +cosX 
cosL  cosa 


The  elements  of  the  third  row  of  C®,',  are  used  in 
the  computations  of  angular ^velocities  and  gravity,  in  addi¬ 
tion  the  first  column  of  C®.',  also  enters  into  the  position 
and  wander  angle  computations  viz; 


L  =  tan' 


tan' 


=  tan" 


a  =  tan 


Note  that  longitude,  and  wander  angle,  a,  are  indeterminate 
at  the  poles  (L  »  +ir/2)  .  Some  special  logic  will  be  required 

at  this  point  so  that  tan‘l  (0/0)  will  return  the  previous  value 
of  or  a. 
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A. 4. 6  The  Space  Stable  Gimbal  Angle  Matrix,  or  Body 

to  Space  Stable  Platform  Transformation^ 

Four  single  axis  rotations  are  normally  required  for 
this  transformation.  The  trivial,  in  this  case,  identity 
matrix,  I,  relating  the  body  freime,  5,  to  the  platform  case 
frame,  6,  is  normally  reserved  for  misalignments  of  the 
case  with  respect  to  the  vehicle.  In  a  non-trivial  case 
Cg®  could  accommodate  an  orientation  of  the  outer  gimbal 
along  the  yaw  axis  rather  than  the  roll  axis  of  the  vehicle. 


The 


,10  . 


signal  flow  form  of  is  shown  in  Figure  A-15. 


0  +Tr/4 


10 


Figure  A-15.  Body  to  Space  Stable  Frame  Transformation 

Calling  6,  +  n/4  0 ' 

^  1 

is  written  as 

=  z(ej)  y(02)  x(03)  zce^)  i 


For  reasonable  computational  efficiency  and  memory 
utilization,  is  subdivided  into  two  two  axis  rotations 

D 

viz : 


where 


Cg°  =  Z(0j^)  Y(02) 
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cos0j^  COS02 

sin0j^ 

-COS 

6isin02 

= 

-sin0|  COS02 

COS0 

sin0j^  sin02 

sin02 

0 

00302 

=  X(93) 

2(64) 

COS0^ 

sine 

'4 

0 

= 

-COS0,  sin0. 

3  4 

COS02 

COS04 

sin©^ 

sin0-  sin0- 
3  4 

-sin©^ 

cos© , 

4 

0030^ 

During  navigation,  is  employed  solely  for  attitude  com 
put at ion. 


The  LVWA  Gimbal  Angle  Matrix,  or  Body  to 

LVWA  Platform  Transformation 

This  transformation  performs  the  same  function  in  a  four 
gimbal,  LVWA  platform  mechanization  as  does  in  a  SS  plat¬ 

form  mechanization. 

However,  assuming  that  the  gimbal  order  for  the  LVWA 
is  azimuth,  inner  roll,  pitch,  outer  roll,  the  order 
of  the  single  axis  rotations  is  different  from  that  specified 
for  the  particular  SS  system  (GEANS)  shown. 
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The  signal  flow  form  is  shown  in  Figure  A-16 ; 


z 


Figure  A-16.  Body  to  LVWA  Platform  Frame  Transformations 
2'  .  . 

Ce  IS  written  as; 

O 

cf  =  xctKj,)  Y(-ej^) 

2 ' 

For  the  same  reasons  as  before,  is  subdivided  into  two 

two  axis  rotations 


where  C 


2' 

3" 


cos(t.Li 

0 

cosijjj^  sin4)j^j 

COSlI^T  COS())t.t 
xj  XjJL 

sintj^T 

Li 

-sim()j^  sin(t)j^j. 

-sintpj^  cos(t>j^j. 

COSlj^j^ 

and  .  C 

y(-0l)  z(- 

-e- 

O 

cos9j^  cos(j)j^Q 

-COS0L  sin<t>^Q 

sin0T 

Jj 

= 

s  1  ntj) 

coscf-Lo 

0 

“Sine^  cos^j-Q 

sin0j^  sin(j)j^Q 

cos0j^ 
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It  should  be  noted  that  none  of  the  local  vertical  sys¬ 
tems  surveyed  (and  a  few  contained  four  gimbal  platforms)  com¬ 
puted  attitude  at  all .  The  attitude  was  obtained  directly 
from  the  readout  of  the  gimbal  resolvers.  The  assumptions 
implicit  in  this  are  =  0,  therefore  (3")  =  (3*),  then 
(4')  =  (4)  and  (3')  =  (3)  and  hence  =  <!>  and  0..  =  6. 

Finally,  +  a  =  tj) . 


A . 4 . 8  Other  Trans formations 


Several  other  transformations  occur  in  one  or  more 


mechanizations.  Two  are  single  axis  rotations;  the  wander 

®ngle  matrix,  C-|  =  X(o()  and  the  inertial  to  earth  fixed 
O'  ^ 

rotation  Cq  =  Z  ;  hence  they  need  no  further  explana¬ 

tion.  A  third,  C^q,  is  shown  in  the  circle  diagram  as  an 
Euler  angle  matrix 


A 


zOg)  Y(e^)  x(0jj) 


However,  this  definition,  i.e.,  of  the  rotations  is  arbitrary 
and,  for  the  purposes  of  this  study,  is  constant. 


A. 4. 9  A  Computational  Simplification 

An  alternate  expression  for  the  LVWA  gimbal  angle  matrix, 
Cg, ,  is  from  Figure  A- 9. 


Cg  =  X(-a)  X(<lJ)  Y(-0)  ZC-ffi) 
=  X(<p-a)y(-0)  Z(-<l>) 


If  the  "attitude-like"  angles  are  extracted  from  C^'  as  pre¬ 
viously  indicated,  pitch  and  roll,  0  and  <P,  will  be  correct 
and  true  heading  will  be  obtained  simply  by  adding  the  wander 
angle,  a,  to  the  "heading-like"  angle,  'I'  -  a. 


A-24 


The  above  simplification  is  used  in  the  attitude  compu¬ 
tations  for  all  three  types  of  INS  employing  LVWA  computa¬ 
tional  frame  and  for  the  LVWA  INS  employing  SS  computational 
frame.  The  computational  flow  diagrams  are  shown  in  Section  2. 
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Appendix  B 

Derivation  of  Fundamental 
Equation  of  Inertial  Navigation 

Preliminaries  (in  Euclidean  3  space) 

Angular  Velocity  (as  Vector)  is  denoted  by  where  a,b,  and  c, 

are  the  designators  for  three  different  Cartesian  coordinate  frames, 
is  read  "the  angular  velocity  of  the  a  frame  with  respect  to  the 
b-frame  expressed  in  c-frame  coordinates." 


Transformation  of  a  Vector 

Angular  velocity  or  any  other  vector  quantity  may  be  expressed 
in  terms  of  its  components  in  any  other  Cartesian  frame  by  pre¬ 
multiplying  the  vector  by  the  rotation  matrix  relating  the  frame 
in  which  the  vector  is  expressed  to  the  frame  in  which  it  is  de¬ 
sired  to  express  it. 

c 

Using  the  example  of  the  angular  velocity  vector, 
previously  defined,  it  might  desired  to  express  this  vector  in  terms 
of  the  coordinates  of  the  a-frame  rather  than  the  c-frame.  If  the 
rotation  from  the  c-frame  to  the  a-frame,  C^,  is  known,  then 


a  ,^a  c 


The  Cross  Product  Operator 

In  an  Euclidean  3  space,  there  is  a  one-to-one  correspondence 
between  the  three  elements  of  a  vector  and  the  non-zero  elements 
of  a  three  by  three,  skew  symmetric  matrix  (isomorphism),  i,e. 


1 - 

1 

o 

“V 

z 

_ 1 

>1 

> 

V 

z 

0 

-vJ 

LvJ 

^x 

0  J 
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In  case  v  is  an  angular  velocity,  w,  the  corresponding  skew  synmietric 
matrix  is  denoted  by  n  e.g. 


When  the  Q  precedes  a  vector,  say,  r. 


then 


to  =  wxr 

Or  introducing  appropriate  subscripts  and  superscripts 

Therefore  is  called  the  "cross-product  operator".  Transforming 
the  cross  product  operator  involves  premultiplying  by  a  rotation 
matrix  and  post  multiplying  by  the  transpose  of  the  rotation  matrix. 

For  the  vector  form  we  had  (as  before) 


C  0), 
c— ba 


For  the  corresponding  skew  symmetric  form  we  have 


Time  Derivative  of  a  Rotation  Matrix 

The  time  rate  of  change  of  the  elements  of  a  rotation  matrix 
in  terms  of  the  angular  rates  expressed  in  either  of  the  terminal 
frames  is  frequently  required .  For  example,  given  the  rotation 
matrix,  C^,  what  is  C^,  where  the  superscript  dot  denotes  ordinary 
differentiation  with  respect  to  time?  As  may  be  demonstrated  in 
a  number  of  ways 
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Derivation 

It  is  now  intended  to  derive  the  vector  expressions  for  the 
derivative  of  the  velocity  of  the  platform  frame  with  respect  to 
the  earth  fixed  frame  expressed  in  platform  frame  coordinates. 

First,  let  r^  be  the  position  vector  from  the  center  of  the 
earth  to  the  vehicle  in  Cartesian  inertial  frame  (i)  coordinates. 
The  same  vector  expressed  in  terms  of  the  coordinates  of  an 
earth-fixed,  earth  centered  (e)  frame  is  r  . 


where 


=  C^r® 
—  e— 


and  the  angular  velocity  of  the  e-frame  relative  to  the  i  frame  is 
a  constant,  (o^^.  Differentiating  (1)  with  respect  tb  time  we 

have 

=  C^r®  +  cV  (2 

—  e—  e— 

but 

ii  =  cV  (4 

r.^1-  v^  =  C^r® 


and  substituting (1) into (4) 


r  =  V  + 

Differentiating  (6)  with  respect  to  time  we  have 

r ^  =  v^  + 

But  noting  that  since  is  a  constant,  and  substituting 


(6)  into  (7)  we  have. 


(8) 


where  r  is  the  total  inertial  acceleration  expressed  in  inertial 
coordinates.  In  the  computational  (C)  frame  (8)  becomes 


but 

(10) 

and 

=  Cj(£^  +  2°)  -  £°  +  2° 

(11) 

where  is  the  specific  force  and  is  mass  attraction  in  the 
inertial  frame.  Substituting  (10)  and  (11)  into  (9). 


but 


but 


f  + 

—  1C—  le—  le  le— 


c  „c 


A  O'-  -  r' 

—  -  —  le  le— 


=  f +  2°  -  (fij^  + 


S2? 

1C 


+ 


c 

ec 


V  =  +  2  -  +  2fi?  )v^ 

ec  le  — 
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APPENDIX  C 


THE  GEODETIC,  THE  ASTRONOMIC  AND 
THE  GEOCENTRIC  LATITUDES 


The  local  mean  sea  level  of  the  earth  is  represented 
by  a  surface  of  a  geoid.  The  average  surface  of  geoid  is 
represented  by  a  spheroid  Can  ellipsoid  of  revolution  about 
the  minor,  polar,  axis  of  the  ellipse) . 

The  geodetic,  the  astronomic  and  the  geocentric  lati¬ 
tudes  definition  are  shown  in  Figure  C-1.  The  latitudes  are 
defined  by  the  angles  in  the  local  meridian  plane.  The  angles 
are  measured  from  the  line  in  the  equatorial  plane,  determined 
by  an  intersection  of  the  local  meridian  plane  with  the  equa- 
tional  plane . 

The  geodetic  latitude  at  the  point  P  is  defined  by  the 
anqle  L  between  the  line  in  the  equatorial  plane  and  the 
normal  to  the  surface  of  the  spheroid. 

The  astronomic  latitude  of  the  point  P  is  defined  by 

the  angle  La  between  the  line  in  the  equatorial  plane  and  the 

normal  to  the  surface  of  the  geoid. 

The  geocentric  latitude  of  the  point  P  is  defined  by 

the  angle  L^  between  the  line  in  the  equatorial  plane  and  the 

line  from  the  earth  center  to  P . 

The  difference  between  the  :geodetic  latitude  and  the 
atronomic  latitude  is  caiosed  by  the  gravity  anomalies  and 
it  is  called  deflection  of  the  vertical  in  the  meridian  plane. 

The  deflection  of  the  vertical  remains  in  large  portion  of  the 
earth  below  10  arc  sec,  but  1  arc  min  deflections  are  also 
encountered. 

0 
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The  difference  between  the  geodetic  latitude  and  the 
geocentric  latitude  is  caused  by  the  earth  oblateness.  The 
latitude  difference  is  also  effected  by  the  altitude  h  of  the 
point  P.  The  difference  between  the  geodetic  latitude,  L  , 
and  the  geocentric  latitude,  L^,  is  given  by:  ^ 

Lg  -  «  f  (1  -  |)  sin  2  Lg 

where  f  =  1/298  is  the  earth  flattening,  R  =  6371000  meters 
is  the  radius  of  the  earth  with  equal  volume  and  h  is  the 
altitude  of  point  P  in  meters • 

At  latitude  45®,  near  the  earth  surface,  the  difference 
between  the  geodetic  and  the  geocentric  latitudes  is  approxi¬ 
mately  1.6  arc  min  and  the  altitude  change  of  30,000  ft  results 
in  1  arc  sec  latitude  difference. 


Figure  C-1.  Latitude  Terminology 


VOLUME  II 
APPENDIX  D 

IMPROVING  THE  ACCURACY  OF  THE  "BASELINE”  LVWA  NAVIGATION  ALGORITHM 


This  appendix  is  addressed  to  one  of  the  several  aspects 
of  the  problem,  namely,  the  more  accurate  numerical  integration 
of  the  differential  equations  involved  in  pure  inertial  navigation. 

The  prime  inputs  to  the  navigation  algorithm, for  the  present 
purpose,  are  the  integrals  of  the  components  of  the  specific  force 
in  the  computational  frame,  over  the  navigation  computation  cycle. 
Together  with  the  initial  conditions,  this  is  all  the  information 
required  for  pure  inertial  navigation. 

The  first  job  of  the  navigation  algorithm,  for  an  earth- 
relative  computational  (c)  frame,  is  the  integration  of  the 
"fundamental  equation  of  inertial  navigation",  the  v  equation 
from  Appendix  B,  over  a  navigation  computation  cycle.  At.  The 
V  equation  is  repeated  below: 


(D-1) 


All  the  symbols  in  the  above  are  defined  in  Appendix  B  and  Section 
2.4.1  of  this  volume.  Integrating  this  equation  from  some  time,  t, 
to  (t  +  At) ,  we  have 


(T)dr 


(D-2) 
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since  the  object  of  the  integration  is  to  obtain  (t  +  At) 
Equation  (D-2)  is  rearranged  as  shown  below; 


t+At 

(t+  t)  =  v°(t)  +  Av°{t+At)  +1  2°(T)dT 

t 


t+At 


t+At 


fi^g(T)  V°(T)dT 


(D-3) 


t+At 


where  Ay^  (t  +  At) 


f  (t)  dT 


Note  that  Av  (t  +  At)  is  the  output  of  an  ideal  (integrating) 
accelerometer  triad  in  the  computational  frame  at  time  (t  +  At) . 

The  underlined  portions  of  Equation  (D-3)  will  not  change 
as  the  algorithm  is  upgraded;  the  potential  accuracy  improvements 
lie  in  obtaining  better  approximations  to  the  three  remaining 
integrals  on  the  right  hand  side  of  Equation  (D-3). 

Before  considering  the  higher  order  algorithm  we  note  that 
manner  in  which  the  "baseline”  algorithm  computes  the  three  integrals 
on  the  right  hand  side,  viz: 


t+At 


g‘^(T)dT 


2°(t)  At 


(D-4) 


'Base 


which  assumes  2^(t)  =  0 


D-2 


t+A.t 


■/. 


ec  — 


=  v‘'(.t).At 

ec  — 

Base 


(D-5) 


which  assumes  Ctl (.t):  -  .0 


t+At 


-I 


a?  Ct)  V^CTldT 
le  — 


=  -2Q?  (;t)  v°(t)At 
le  — 

Base 
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which  assumes  Ct) ,  v  ( t)  —  0 


Hence  the  baseline  navigation  algorithm  (without  vertical  damping) 
is  given  by 


(t+At) 


s=  (t)  +Av^  ( t+At)  +  g  (t)At 

Base*” 


v*^  (t)  At 
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There  are  some  conputational  lags  and  further  approximations  in 
the  computation  of  symmetric  form  of  P°(t)  ,  but 

these  may  be  dealt  with  later . 

For  notational  compactness,  it  is  expedient  to  define 
angular  velocity  vector,  a)°(t),  and  its  skew  symmetric  counter¬ 
part,  n°(t),  as 


and 


4  ^  2w?g(t) 

n°(t)  4  ^2°  (t)  +  2J2jg{t) 


(D-8a) 

(D-8b) 


D-3 


t+At 

f  [“loM  + 
4 


t+A,t 


y(TjdT 


Ct).  (t1  dx 


(D-9) 


Expanding  the  integrands  in  Eq.  (D-3)  in  Taylor’s  series  about  t, 
we  have 


6v^ (t+At) 


t+At 

A  f  2.*^ (t) 

4 


(D-10) 


t+At 


=j  1^  2^(t)  +  2°(t)(T-t)  +  g°(t)SlZ^  +  . 


2°(t)At  +  2°(t)  ^  +  2^°(t)  ^  + 


Similarly 


-6v°(t+At) 


t+At 


A  r  ( T ) 

4 


{T)dT 
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where  fi°(T)  =  fi°{t)  +  fi^(t)  (x-t)  +  (t) iy.)  + 

and  v°{x)  =  v°(t)  +  y°(t){x-t)  +  v°(t)ly^^  + 


Then  the  integrand/  ^  is  given  by 

S^°(x)v®(x)  =  n*^(t)v°(t) 


(D-12) 
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The  "baseline"  (first  order)  algorithm  may  be  upgraded  to  a 
second  order  algorithm  by  adding  the  second  terms  (those  multi¬ 
plied  by  of  Equations  (D-10)  and  (D-13)  to  Equation  (D-7)  . 

v°(t+At)  2nd  =  v°(t)  +  (t+At)  +  2°(t)  At  (D-14) 

order 

(t)  v^(t)  At  +  £*^(t) 

-jfi°(t)v°(t)  +  fi°(t)v°(t)j^ 

To  generate  Equation  (D-14) ,  we  need  the  three  derivatives  (in  a 
vector  sense  -  actually  nine  derivatives)  y  (t) ,  2  (t)  and  Q  (t) 
or  w^{t).  If  these  derivatives  can  be  generated,  the  navigation 
algorithm  can  be  upgraded  not  only  to  the  second  order  but  may 
also  include  part  of  the  third  order  algorithm,  fi  (t)v  (t)At  /3. 
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The  asstimptions  in  the  second  order  algorithm  are 
v^Ct),  £°(.t),  =0. 

Subject  to  the  above  assumptions#  one  may  regroup  the  terms  in 
£*^(t)  and  £°(.t)  viz: 

g'"  .  2 

^‘^Ct+At)  =  £°{t)At  +  £°{t)  ^|-  (D-15 

2nd 

=  ^£°(t)  +  ^^{t)  At 

Therefore,  if  we  can  obtain  an  estimate  of  the  extrapolated  value 
of  £  at  the  midpoint  point  of  the  next  computation  cycle,  we  have 
effectively  incorporated  its  derivative  at  the  present  time.  The 
mechanism  for  computing  the  extrapolated  value  of  ,  simply  con¬ 
sists  of  noting  that 

2=(t+^)  -  h  (D-16 

where  L  is  geodetic  latitude 

a  is  wander  angle 
h  is  altitude 

as  may  be  seen  from  any  of  Equations  (2-39)  (2-62)  or  (2-78)  in 

Sections  2. 4. 1.2/ 2.4.3  or  2.4.4  of  this  volume. 
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The  required  functions  of  L  and  a  are  contained  in  the  extrap¬ 
olated  dcm  while  h  may  be  extrapolated  directly.  Therefore  an 
estimate  of  g*^(t+^^)  maybe  obtained  at  t  for  use  at  (t+At)  . 

Now  we  attempt  to  upgrade  the  (t+At)  ^  computation  by 


Iv 

replacing  fi^(.t)  v°(t)  At  by  Ct+^)  v°  (t+^)  At 

where 

fi°(t+^)  =  n^(t)  +  fi°(t) 

At 

2 

and 

v^(t+^)  =  v*^(t)  +  v^  (t) 

At 

2 

if 

V°(t),  sj°(t)  =  0 

(D-17) 

Then 

fi°(t+^)  v°(t+^)  At  = 

n°(t)fi°(t)^j[^v^(t)  +v°(t)^jAt 

= 

Jj‘^(t)v‘^(t)At 

a°(t)v°(t)  +  fi°(t)v°(t)]^ 

|^^(t)v°(t)] 

Hence  using  the  mid-computation  cycle  values  of  angular  velocity 
and  velocity  not  only  gives  the  correct  second  terms  for  (wxv) At 
but  also  3/4 's  of  one  of  the  third  order  terms  of  Equation  (D-13) . 

c  At 

The  method  of  obtaining  the  estimates  of  v  (t+-^)  and 
fi®(t+^)  is  straightforward.  Before  v*^(t)  is  updated  at  time  t, 
from  time  (t-At) ,  the  old  value  is  stored  and  the  extrapolated 


value  is  estimated  as 

y^(t+^)  4  v°(t)  + 


r^(t)  -  v^(t-At) 


(D-18) 


1 

2 


[ 


3v°(t)  -  v'^Ct-At) 
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There  is,  of  course,  a  lag  of  ^  in  the  computed  derivative  of 
velocity  but  it  is  better  than  no  derivative  at  all  and  besides 
it  is  very  inexpensive  computationally. 

The  estimated  angular  velocity,  at  time  (t+^)  may  be 
written  as 


(.t+^)  = 


v''(.t+^), 


L(t+^)  , 


h(t+^) 


(D-19) 


c  At 

That  is,  u  tt+-y)  is  a  function  of  the  same  variables  as  £°(t+At) 
plus  the  linear  velocity  v  (t+^) ,  which  latter  we  have  just 
estimated. 


The  extrapolated  dcm,  C®  (t+^) ,  which  contains  the  appro 
priate  functions  of  L  and  a,  is  obtained  as  an  almost  painless 
byproduct  of  the  update  of  the  dcm  from  time  (t-At)  to  time  t 
(the  second  integration).  The  dcm  update,  per  se,  which  is 
assvimed  to  be  second  or  higher  order,  constructs  an  additive 
"update"  matrix  6C®(t,t-At)  which  is  stored,  then  added  to  the 
"old"  dcm,  C®(t-At)  as  shown  below 


C®(t)  =  C®(t-At)  +  AC® (t, t-At) 


(D-20) 


The  extrapolated  dcm  is  given  by 
C®(t+^)  =  c®(t)  +  I  6C®(t,t-At) 

The  "update"  matrix  itself  is  of  the  form 


'5C®(t,t-At)  =  C®(t-At)! 
c  c  )  ec 


(D-21) 


(D-22) 


where  ft®^(t-^)  is  the  skew  symmetric  form  of  m®  (t-^)  or  ) 

e  angu  ar  velocity  of  the  computational  frame  with  respect  to  the 
earth  fixed  frame,  expressed  in  the  computational  frame,  and  com¬ 
puted  at  midpoint  of  the  computation  cycle. 
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The  angular  velocity,  ^  function  of  the  same  vari 

c  At  • 

cibles  as  JJ  Ct— 2“)  i.e»» 


*=  ct-^) 


Ltt-^l 


/4. 

a  Ct — Y> 


h  ( t-^) 


(D-23) 


Rather  than  use  the  extrapolated  value  of  v°  from  the  previous 
computation  cycle,  it  is  more  accurate  and  almost  as  simple  to 
use  an  interpolated  value  of  v°  from  the  present  computation 
cycle. 

Define  v°  (t-^)  by 

vC(t-“)  S  I  [v°(t)  +  v'Ct-At)]  (D-24) 

For  the  remaining  three  variables  (or  functions  thereof)  it  is 
sufficient  to  use  the  extrapolated  values  from  the  previous 
computation  cycle. 

The  other  part  of  f2°(t-^),  ,  is  strictly  a  func¬ 
tion  of  L,  a,  and  i.e., 

-  “le''4  [  <‘-¥' '  “ 

Here,  is  obtained  directly  from  the  elements  of  the  extrapolated 
dcm  from  the  previous  computation  cycle. 

Putting  all  the  foregoing  together  in  the  appropriate  order, 
along  with  suitable  initialization,  and  vertical  damping  (see 
Appendix  F) ,  and  we  have  the  "Upgraded  LVWA  Navigation  Algorithm" 
(see  Section  2.4  of  this  volume)  -  which  might  approach  the 
accuracy  of  a  vastly  simpler  space  stable  navigation  algorithm. 
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APPENDIX  E 

APPROXIMATING  THE  MID  COMPUTATION  CYCLE  TRANSFORMATION 

In  the  strapdown  computations  the  mid-computation  cycle  transfer- 

c 

mation  from  the  body  frame  to  the  computational  frame,  C.  ,  is 

'^N-1/2 

approximated  by 

Cj  =  j  (c°  +  C°  \ 

^N-1/2  ^  \  ^N  ^N-1/ 

A  direction  cosine  matrix  or  quaternion  update  is  used  to  update 
Cp  to  Cp  .  Consider  the  d.c.m.  update.  Then 

Vl  ^N 

c°  =  c°  c(e) 

^N  ^N-l 

where  C(6)  =  I  +  R  sin  6  +  R^  (1-cos  6) 


0  -c  b 

and  R  =  c  0  -a 

-b  a  0 


where  a,b,c  are  the  direction 
cosines  of  the  axis  of  rotation 


Hence  Cp  =  4  C°  [I  +  I  +  R  sin6  +  R^  (l-cosS)] 

Vl/2  2  Vl 


=  +  C°  R  ^  +  r2 

Vl  *"n-i  [  2 


The  exact  expression  for  C, 


N-1/2 


,  assuming  9  is  a  constant,  is  given 


:p  =  I  +  R  Sin(|-)  +  R^  [l-cos/y] 

Vl/2  [  \2/  V  \2/ 

=  Cp  +  Cp  R  sin 

‘“h-i  *>H-1  L 


R  sin  /l~cos 


(!))] 
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The  error  is  the  approximation  is 


C*'  - 

^N-1/2  ^N-1/2 


'  ^  (t)] 


(M)-(lcos(f))]j 


Expanding  sin  0,  cos  6,  sin^^j  ,  cos  to  the  third  power  in  0 

6  ^  Q  2 

sin  6  =  0-  cos  9  =  1-  ^ 


2  “  48'  ‘^°®\2/  “  ^  ■  T 

Inserting  these  expressions  and  simplifying  gives 


Ch  -  C?  = 

'’n-1/2  “n-1/2 


r 

-J- 


R  +  r2  ^ 
16  8 


If  rotation  is  entirely  about  the  roll  (longitudinal)  axis,  then  the 
direction  cosines  of  the  axis  of  rotation  are  {a,b,c}  ={001} 


0  10  -10  0 
and  R  =  -1  0  0  ,  =  0-1  0 

0  0  0  0  0  0 

3 

The  -R9  /16  term  will  produce  a  very  small  rotational  error  in  the 
normal  and  lateral  components  of  the  integral  of  specific  force 
which  would  cancel  out  at  the  end  of  the  turn. 

2  2 

The  R  6  /8  will  produce  a  scale  factor  error  in  both  the 
normal  and  lateral  components  which  will  be  rectified  and  hence,  will 
not  cancel  out  at  the  completion  of  the  turn.  The  nature  of  this 
error  is  such  that  it  does  not  propagate  directly  into  an  attitude 
error,  but  since  it  introduces  a  scale  factor  error  into  the  incre¬ 
mental  velocity  while  the  attitude  is  changing,  it  will  integrate  into 
velocity  and  hence  position  error  and  into  the  computed  vehicle  rate 
where  it  will  ultimately  produce  an  attitude  error. 
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The  magnitude  of  the  lateral  velocity  error  introduced  during 
the  roll-up  and  roll  down  portion  of  a  1/2-g  horizontal  turn,  when 
the  constant  roll  rate  is  180  degrees  per  second  and  the  strap- 
down  computation  cycle.  At,  is  1/128  of  a  second  is  computed  below. 

The  scale  factor  error,  Sgp,  is 


^  .  liiWiI)-  .  ,2  X  2-’  =  75  ppm 

O  o 


The  maximum  roll  angle,  4)^^,  is 

4)  =  tan"^  1/2  =.  26.656° 

m 


The  roll  up  time,  t^,  is 

4) 

t  =  ^  =  0.1475  sec 

The  lateral  velocity  error  at  the  completion  of  the  term  is  the 
scale  factor  error  times  the  area  under  the  lateral  acceleration 
curve 

eVlegp  =  Egp  2t^ 

—  t;  —  3 

=  7.5x10  xl6x.l475  =  0.177x10  fps 

This  is  a  significant  error.  It  may  be  eliminated  in  one  of  two 
ways.  The  simplest  is  to  alternate  the  ** attitude"  matrix  update 
with  the  AV  transformation  so  that  no  interpolation  is  required, 
which  is  a  practical  solution  adopted  by  some  strapdown  systems. 

The  second,  which  is  applicable  to  the  present  case  i.e.  PROFGEN/ 
NUMSIM,  consists  of  performing  a  second  update  of  the  "attitude" 
matrix  using  half  the  incremental  angles  and  a  second  or  higher 
order  update. 

The  efficient  incorporation  of  these  operations  into  the  d.c.m. 
and  quaternion  updates  should  be  investigated  during  any  follow-on 
efforts. 
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APPENDIX  F 

VERTICAL  DAMPING  FOR  THE  "UPGRADED"  ALGORITHM 

The  assumption  invoked  throughout  the  algorithm  development  has 
been  (and  still  is)  that  information  is  available  at  the  end  of  a 
computation  cycle  and  that  outputs  are  to  be  provided  appropriate 
to  the  end  of  the  computation  cycle. 

This  implies  that  the  computer  time  required  to  update  the  out¬ 
puts  (which  is  in  the  range  of  a  few  milliseconds  to  tens  of  milli¬ 
seconds)  is  a  negligible  delay.  For  some  purposes  this  delay  may  not 
be  acceptable  and  specific  steps  may  have  to  be  taken  to  extrapolate 
INS  output  parameters  ahead  to  the  time  of  their  intended  use. 

At  any  rate ,  there  is  a  premium  to  be  placed  on  minimizing  the 
delay  between  accepting  input  data  and  outputing  the  updated  navigation 
and  attitude  data,  particularly  the  rapidly  changing  outputs,  such 
as  velocity.  Therefore,  the  data  required  for  velocity  updating, 
including  the  vertical  damping,  but  excepting  the  incremental 
velocity,  are  all  computed  at  the  end  of  the  previous  computation 
cycle  for  use  in  the  early  portions  of  the  present  update  cycle. 

Tfie  rationale  for  the  improved  accuracy  navigation  algorithm 
was  outlined  in  Appendix  D  of  this  volume,  while  the  algorithm  proper 
was  presented  in  Section  2.4  of  this  volume.  The  continuous  form 
of  the  damped  vertical  channel  was  shown  in  Section  2.4.2  of  this 
volume . 

The  only  additional  coding  specifically  required  to  upgrade  the 
vertical  damping  mechanization  is  the  extrapolation  of  the  reference 
altitude  to  mid-computation  cycle.  (The  system  computed  altitude 
was  already  extrapolated  to  mid-computation  cycle  for  the  "gravity" 
computation) . 
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The  upgraded  vertical  channel  computations  are  shown  in 
Figure  F-1  in  the  detailed  computation  flow  diagram.  Below 
the  dashed  line  are  the  (linearized)  undamped  vertical  danping 
calculations  proper.  In  Figure  F-1,  the  inputs  to  the  "unit  delay" 
boxes,  were  computed  during  the  previous  cycle,  and  become  the 
outputs  of  the  boxes  during  the  present  cycle  (after  which  the 
inputs  are  updated  again) .  It  is  obvious  from  the  figure  that 
a  very  modest  number  of  arithmetic  (consisting  of  summation  and 
scaling)  operations  are  required  to  update  the  velocity  —  once 
the  incremental  velocity  is  available. 
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Upgraded"  Algorithm  (at  end  of  nth  computa- 
ion  cycle) 
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